2012-01-11 18:25:17 +01:00
|
|
|
/*
|
|
|
|
* linux/arch/arm/kernel/arch_timer.c
|
|
|
|
*
|
|
|
|
* Copyright (C) 2011 ARM Ltd.
|
|
|
|
* All Rights Reserved
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*/
|
|
|
|
#include <linux/init.h>
|
2012-11-12 15:33:44 +01:00
|
|
|
#include <linux/types.h>
|
2013-02-14 17:45:25 +01:00
|
|
|
#include <linux/errno.h>
|
2012-01-11 18:25:17 +01:00
|
|
|
|
2012-09-21 19:51:44 +02:00
|
|
|
#include <asm/delay.h>
|
2011-01-14 16:32:36 +01:00
|
|
|
#include <asm/sched_clock.h>
|
2012-01-11 18:25:17 +01:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
#include <clocksource/arm_arch_timer.h>
|
2012-09-07 19:09:57 +02:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
static unsigned long arch_timer_read_counter_long(void)
|
2012-01-11 18:25:17 +01:00
|
|
|
{
|
2012-11-14 10:50:19 +01:00
|
|
|
return arch_timer_read_counter();
|
2012-01-11 18:25:17 +01:00
|
|
|
}
|
|
|
|
|
2013-03-11 22:23:46 +01:00
|
|
|
static u32 sched_clock_mult __read_mostly;
|
|
|
|
|
|
|
|
static unsigned long long notrace arch_timer_sched_clock(void)
|
2012-07-06 16:46:45 +02:00
|
|
|
{
|
2013-03-11 22:23:46 +01:00
|
|
|
return arch_timer_read_counter() * sched_clock_mult;
|
2012-07-06 16:46:45 +02:00
|
|
|
}
|
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
static struct delay_timer arch_delay_timer;
|
2012-01-20 11:47:00 +01:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
static void __init arch_timer_delay_timer_register(void)
|
2012-01-11 18:25:17 +01:00
|
|
|
{
|
2012-09-21 19:51:44 +02:00
|
|
|
/* Use the architected timer for the delay loop. */
|
2012-11-12 15:33:44 +01:00
|
|
|
arch_delay_timer.read_current_timer = arch_timer_read_counter_long;
|
|
|
|
arch_delay_timer.freq = arch_timer_get_rate();
|
2012-09-21 19:51:44 +02:00
|
|
|
register_current_timer_delay(&arch_delay_timer);
|
2012-01-11 18:25:17 +01:00
|
|
|
}
|
2011-01-14 16:32:36 +01:00
|
|
|
|
2012-01-19 14:53:50 +01:00
|
|
|
int __init arch_timer_of_register(void)
|
|
|
|
{
|
2012-11-12 15:33:44 +01:00
|
|
|
int ret;
|
2012-01-19 14:53:50 +01:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
ret = arch_timer_init();
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
2012-01-19 14:53:50 +01:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
arch_timer_delay_timer_register();
|
2012-09-07 19:09:57 +02:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
return 0;
|
2012-01-19 14:53:50 +01:00
|
|
|
}
|
|
|
|
|
2011-01-14 16:32:36 +01:00
|
|
|
int __init arch_timer_sched_clock_init(void)
|
|
|
|
{
|
2013-03-11 22:23:46 +01:00
|
|
|
u32 arch_timer_rate = arch_timer_get_rate();
|
|
|
|
|
|
|
|
if (arch_timer_rate == 0)
|
2012-11-12 15:33:44 +01:00
|
|
|
return -ENXIO;
|
2011-01-14 16:32:36 +01:00
|
|
|
|
2013-03-11 22:23:46 +01:00
|
|
|
/* Cache the sched_clock multiplier to save a divide in the hot path. */
|
|
|
|
sched_clock_mult = NSEC_PER_SEC / arch_timer_rate;
|
|
|
|
sched_clock_func = arch_timer_sched_clock;
|
|
|
|
pr_info("sched_clock: ARM arch timer >56 bits at %ukHz, resolution %uns\n",
|
|
|
|
arch_timer_rate / 1000, sched_clock_mult);
|
|
|
|
|
2011-01-14 16:32:36 +01:00
|
|
|
return 0;
|
|
|
|
}
|