ARM: convert arm/arm64 arch timer to use CLKSRC_OF init
[linux-3.10.git] / arch / arm / kernel / arch_timer.c
1 /*
2  *  linux/arch/arm/kernel/arch_timer.c
3  *
4  *  Copyright (C) 2011 ARM Ltd.
5  *  All Rights Reserved
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 #include <linux/init.h>
12 #include <linux/types.h>
13 #include <linux/errno.h>
14
15 #include <asm/delay.h>
16 #include <asm/sched_clock.h>
17
18 #include <clocksource/arm_arch_timer.h>
19
20 static unsigned long arch_timer_read_counter_long(void)
21 {
22         return arch_timer_read_counter();
23 }
24
25 static u32 sched_clock_mult __read_mostly;
26
27 static unsigned long long notrace arch_timer_sched_clock(void)
28 {
29         return arch_timer_read_counter() * sched_clock_mult;
30 }
31
32 static struct delay_timer arch_delay_timer;
33
34 static void __init arch_timer_delay_timer_register(void)
35 {
36         /* Use the architected timer for the delay loop. */
37         arch_delay_timer.read_current_timer = arch_timer_read_counter_long;
38         arch_delay_timer.freq = arch_timer_get_rate();
39         register_current_timer_delay(&arch_delay_timer);
40 }
41
42 int __init arch_timer_arch_init(void)
43 {
44         u32 arch_timer_rate = arch_timer_get_rate();
45
46         if (arch_timer_rate == 0)
47                 return -ENXIO;
48
49         arch_timer_delay_timer_register();
50
51         /* Cache the sched_clock multiplier to save a divide in the hot path. */
52         sched_clock_mult = NSEC_PER_SEC / arch_timer_rate;
53         sched_clock_func = arch_timer_sched_clock;
54         pr_info("sched_clock: ARM arch timer >56 bits at %ukHz, resolution %uns\n",
55                 arch_timer_rate / 1000, sched_clock_mult);
56
57         return 0;
58 }