blob: 36ebcf4b516f291be14c7943764a41728a12c912 [file] [log] [blame]
Marc Zyngier022c03a2012-01-11 17:25:17 +00001/*
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 Rutland8a4da6e2012-11-12 14:33:44 +000012#include <linux/types.h>
Marc Zyngier022c03a2012-01-11 17:25:17 +000013
Jonathan Austin56942fe2012-09-21 18:51:44 +010014#include <asm/delay.h>
Marc Zyngier3f61c802011-01-14 15:32:36 +000015#include <asm/sched_clock.h>
Marc Zyngier022c03a2012-01-11 17:25:17 +000016
Mark Rutland8a4da6e2012-11-12 14:33:44 +000017#include <clocksource/arm_arch_timer.h>
Marc Zyngierf48b5f12012-09-07 18:09:57 +010018
Mark Rutland8a4da6e2012-11-12 14:33:44 +000019static unsigned long arch_timer_read_counter_long(void)
20{
21 return arch_timer_read_counter();
22}
Marc Zyngierf48b5f12012-09-07 18:09:57 +010023
Mark Rutland8a4da6e2012-11-12 14:33:44 +000024static u32 arch_timer_read_counter_u32(void)
25{
26 return arch_timer_read_counter();
27}
Marc Zyngier022c03a2012-01-11 17:25:17 +000028
Jonathan Austin56942fe2012-09-21 18:51:44 +010029static struct delay_timer arch_delay_timer;
Will Deacond0a533b2012-07-06 15:47:17 +010030
Mark Rutland8a4da6e2012-11-12 14:33:44 +000031static void __init arch_timer_delay_timer_register(void)
Marc Zyngierf48b5f12012-09-07 18:09:57 +010032{
Jonathan Austin56942fe2012-09-21 18:51:44 +010033 /* Use the architected timer for the delay loop. */
Mark Rutland8a4da6e2012-11-12 14:33:44 +000034 arch_delay_timer.read_current_timer = arch_timer_read_counter_long;
35 arch_delay_timer.freq = arch_timer_get_rate();
Jonathan Austin56942fe2012-09-21 18:51:44 +010036 register_current_timer_delay(&arch_delay_timer);
Marc Zyngier022c03a2012-01-11 17:25:17 +000037}
Marc Zyngier3f61c802011-01-14 15:32:36 +000038
Marc Zyngier00752422012-01-19 13:53:50 +000039int __init arch_timer_of_register(void)
40{
Mark Rutland8a4da6e2012-11-12 14:33:44 +000041 int ret;
Marc Zyngier00752422012-01-19 13:53:50 +000042
Mark Rutland8a4da6e2012-11-12 14:33:44 +000043 ret = arch_timer_init();
44 if (ret)
45 return ret;
Marc Zyngier00752422012-01-19 13:53:50 +000046
Mark Rutland8a4da6e2012-11-12 14:33:44 +000047 arch_timer_delay_timer_register();
Marc Zyngier00752422012-01-19 13:53:50 +000048
Mark Rutland8a4da6e2012-11-12 14:33:44 +000049 return 0;
Marc Zyngier00752422012-01-19 13:53:50 +000050}
Marc Zyngier00752422012-01-19 13:53:50 +000051
Marc Zyngier3f61c802011-01-14 15:32:36 +000052int __init arch_timer_sched_clock_init(void)
53{
Mark Rutland8a4da6e2012-11-12 14:33:44 +000054 if (arch_timer_get_rate() == 0)
55 return -ENXIO;
Marc Zyngier3f61c802011-01-14 15:32:36 +000056
Mark Rutland8a4da6e2012-11-12 14:33:44 +000057 setup_sched_clock(arch_timer_read_counter_u32,
58 32, arch_timer_get_rate());
Marc Zyngier3f61c802011-01-14 15:32:36 +000059 return 0;
60}