blob: d957a51435d808eb73743886a888e356b00f0bf2 [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>
Arnd Bergmannfe7dc722013-02-14 17:45:25 +010013#include <linux/errno.h>
Marc Zyngier022c03a2012-01-11 17:25:17 +000014
Jonathan Austin56942fe2012-09-21 18:51:44 +010015#include <asm/delay.h>
Marc Zyngier3f61c802011-01-14 15:32:36 +000016#include <asm/sched_clock.h>
Marc Zyngier022c03a2012-01-11 17:25:17 +000017
Mark Rutland8a4da6e2012-11-12 14:33:44 +000018#include <clocksource/arm_arch_timer.h>
Marc Zyngierf48b5f12012-09-07 18:09:57 +010019
Mark Rutland8a4da6e2012-11-12 14:33:44 +000020static unsigned long arch_timer_read_counter_long(void)
21{
22 return arch_timer_read_counter();
23}
Marc Zyngierf48b5f12012-09-07 18:09:57 +010024
Mark Rutland8a4da6e2012-11-12 14:33:44 +000025static u32 arch_timer_read_counter_u32(void)
26{
27 return arch_timer_read_counter();
28}
Marc Zyngier022c03a2012-01-11 17:25:17 +000029
Jonathan Austin56942fe2012-09-21 18:51:44 +010030static struct delay_timer arch_delay_timer;
Will Deacond0a533b2012-07-06 15:47:17 +010031
Mark Rutland8a4da6e2012-11-12 14:33:44 +000032static void __init arch_timer_delay_timer_register(void)
Marc Zyngierf48b5f12012-09-07 18:09:57 +010033{
Jonathan Austin56942fe2012-09-21 18:51:44 +010034 /* Use the architected timer for the delay loop. */
Mark Rutland8a4da6e2012-11-12 14:33:44 +000035 arch_delay_timer.read_current_timer = arch_timer_read_counter_long;
36 arch_delay_timer.freq = arch_timer_get_rate();
Jonathan Austin56942fe2012-09-21 18:51:44 +010037 register_current_timer_delay(&arch_delay_timer);
Marc Zyngier022c03a2012-01-11 17:25:17 +000038}
Marc Zyngier3f61c802011-01-14 15:32:36 +000039
Marc Zyngier00752422012-01-19 13:53:50 +000040int __init arch_timer_of_register(void)
41{
Mark Rutland8a4da6e2012-11-12 14:33:44 +000042 int ret;
Marc Zyngier00752422012-01-19 13:53:50 +000043
Mark Rutland8a4da6e2012-11-12 14:33:44 +000044 ret = arch_timer_init();
45 if (ret)
46 return ret;
Marc Zyngier00752422012-01-19 13:53:50 +000047
Mark Rutland8a4da6e2012-11-12 14:33:44 +000048 arch_timer_delay_timer_register();
Marc Zyngier00752422012-01-19 13:53:50 +000049
Mark Rutland8a4da6e2012-11-12 14:33:44 +000050 return 0;
Marc Zyngier00752422012-01-19 13:53:50 +000051}
Marc Zyngier00752422012-01-19 13:53:50 +000052
Marc Zyngier3f61c802011-01-14 15:32:36 +000053int __init arch_timer_sched_clock_init(void)
54{
Mark Rutland8a4da6e2012-11-12 14:33:44 +000055 if (arch_timer_get_rate() == 0)
56 return -ENXIO;
Marc Zyngier3f61c802011-01-14 15:32:36 +000057
Mark Rutland8a4da6e2012-11-12 14:33:44 +000058 setup_sched_clock(arch_timer_read_counter_u32,
59 32, arch_timer_get_rate());
Marc Zyngier3f61c802011-01-14 15:32:36 +000060 return 0;
61}