Marc Zyngier | 022c03a | 2012-01-11 17:25:17 +0000 | [diff] [blame] | 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> | ||||
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 12 | #include <linux/types.h> |
Arnd Bergmann | fe7dc72 | 2013-02-14 17:45:25 +0100 | [diff] [blame^] | 13 | #include <linux/errno.h> |
Marc Zyngier | 022c03a | 2012-01-11 17:25:17 +0000 | [diff] [blame] | 14 | |
Jonathan Austin | 56942fe | 2012-09-21 18:51:44 +0100 | [diff] [blame] | 15 | #include <asm/delay.h> |
Marc Zyngier | 3f61c80 | 2011-01-14 15:32:36 +0000 | [diff] [blame] | 16 | #include <asm/sched_clock.h> |
Marc Zyngier | 022c03a | 2012-01-11 17:25:17 +0000 | [diff] [blame] | 17 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 18 | #include <clocksource/arm_arch_timer.h> |
Marc Zyngier | f48b5f1 | 2012-09-07 18:09:57 +0100 | [diff] [blame] | 19 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 20 | static unsigned long arch_timer_read_counter_long(void) |
21 | { | ||||
22 | return arch_timer_read_counter(); | ||||
23 | } | ||||
Marc Zyngier | f48b5f1 | 2012-09-07 18:09:57 +0100 | [diff] [blame] | 24 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 25 | static u32 arch_timer_read_counter_u32(void) |
26 | { | ||||
27 | return arch_timer_read_counter(); | ||||
28 | } | ||||
Marc Zyngier | 022c03a | 2012-01-11 17:25:17 +0000 | [diff] [blame] | 29 | |
Jonathan Austin | 56942fe | 2012-09-21 18:51:44 +0100 | [diff] [blame] | 30 | static struct delay_timer arch_delay_timer; |
Will Deacon | d0a533b | 2012-07-06 15:47:17 +0100 | [diff] [blame] | 31 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 32 | static void __init arch_timer_delay_timer_register(void) |
Marc Zyngier | f48b5f1 | 2012-09-07 18:09:57 +0100 | [diff] [blame] | 33 | { |
Jonathan Austin | 56942fe | 2012-09-21 18:51:44 +0100 | [diff] [blame] | 34 | /* Use the architected timer for the delay loop. */ |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 35 | arch_delay_timer.read_current_timer = arch_timer_read_counter_long; |
36 | arch_delay_timer.freq = arch_timer_get_rate(); | ||||
Jonathan Austin | 56942fe | 2012-09-21 18:51:44 +0100 | [diff] [blame] | 37 | register_current_timer_delay(&arch_delay_timer); |
Marc Zyngier | 022c03a | 2012-01-11 17:25:17 +0000 | [diff] [blame] | 38 | } |
Marc Zyngier | 3f61c80 | 2011-01-14 15:32:36 +0000 | [diff] [blame] | 39 | |
Marc Zyngier | 0075242 | 2012-01-19 13:53:50 +0000 | [diff] [blame] | 40 | int __init arch_timer_of_register(void) |
41 | { | ||||
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 42 | int ret; |
Marc Zyngier | 0075242 | 2012-01-19 13:53:50 +0000 | [diff] [blame] | 43 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 44 | ret = arch_timer_init(); |
45 | if (ret) | ||||
46 | return ret; | ||||
Marc Zyngier | 0075242 | 2012-01-19 13:53:50 +0000 | [diff] [blame] | 47 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 48 | arch_timer_delay_timer_register(); |
Marc Zyngier | 0075242 | 2012-01-19 13:53:50 +0000 | [diff] [blame] | 49 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 50 | return 0; |
Marc Zyngier | 0075242 | 2012-01-19 13:53:50 +0000 | [diff] [blame] | 51 | } |
Marc Zyngier | 0075242 | 2012-01-19 13:53:50 +0000 | [diff] [blame] | 52 | |
Marc Zyngier | 3f61c80 | 2011-01-14 15:32:36 +0000 | [diff] [blame] | 53 | int __init arch_timer_sched_clock_init(void) |
54 | { | ||||
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 55 | if (arch_timer_get_rate() == 0) |
56 | return -ENXIO; | ||||
Marc Zyngier | 3f61c80 | 2011-01-14 15:32:36 +0000 | [diff] [blame] | 57 | |
Mark Rutland | 8a4da6e | 2012-11-12 14:33:44 +0000 | [diff] [blame] | 58 | setup_sched_clock(arch_timer_read_counter_u32, |
59 | 32, arch_timer_get_rate()); | ||||
Marc Zyngier | 3f61c80 | 2011-01-14 15:32:36 +0000 | [diff] [blame] | 60 | return 0; |
61 | } |