162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * 462306a36Sopenharmony_ci * Copyright (C) 2014 ARM Limited 562306a36Sopenharmony_ci */ 662306a36Sopenharmony_ci 762306a36Sopenharmony_ci#include <linux/clocksource.h> 862306a36Sopenharmony_ci#include <linux/io.h> 962306a36Sopenharmony_ci#include <linux/of.h> 1062306a36Sopenharmony_ci#include <linux/of_address.h> 1162306a36Sopenharmony_ci#include <linux/sched_clock.h> 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_ci#define SYS_24MHZ 0x05c 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_cistatic void __iomem *versatile_sys_24mhz; 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_cistatic u64 notrace versatile_sys_24mhz_read(void) 1862306a36Sopenharmony_ci{ 1962306a36Sopenharmony_ci return readl(versatile_sys_24mhz); 2062306a36Sopenharmony_ci} 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_cistatic int __init versatile_sched_clock_init(struct device_node *node) 2362306a36Sopenharmony_ci{ 2462306a36Sopenharmony_ci void __iomem *base = of_iomap(node, 0); 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci of_node_clear_flag(node, OF_POPULATED); 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ci if (!base) 2962306a36Sopenharmony_ci return -ENXIO; 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci versatile_sys_24mhz = base + SYS_24MHZ; 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci sched_clock_register(versatile_sys_24mhz_read, 32, 24000000); 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_ci return 0; 3662306a36Sopenharmony_ci} 3762306a36Sopenharmony_ciTIMER_OF_DECLARE(vexpress, "arm,vexpress-sysreg", 3862306a36Sopenharmony_ci versatile_sched_clock_init); 3962306a36Sopenharmony_ciTIMER_OF_DECLARE(versatile, "arm,versatile-sysreg", 4062306a36Sopenharmony_ci versatile_sched_clock_init); 41