| 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 | } | ||||