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