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>
|
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
|
|
|
}
|
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
static u32 arch_timer_read_counter_u32(void)
|
2012-07-06 16:46:45 +02:00
|
|
|
{
|
2012-11-14 10:50:19 +01:00
|
|
|
return arch_timer_read_counter();
|
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)
|
|
|
|
{
|
2012-11-12 15:33:44 +01:00
|
|
|
if (arch_timer_get_rate() == 0)
|
|
|
|
return -ENXIO;
|
2011-01-14 16:32:36 +01:00
|
|
|
|
2012-11-12 15:33:44 +01:00
|
|
|
setup_sched_clock(arch_timer_read_counter_u32,
|
|
|
|
32, arch_timer_get_rate());
|
2011-01-14 16:32:36 +01:00
|
|
|
return 0;
|
|
|
|
}
|