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