115 lines · 2.5 KB · C
RawDownload
/* * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) * Licensed under the GPL */ #include <linux/clockchips.h>#include <linux/init.h>#include <linux/interrupt.h>#include <linux/jiffies.h>#include <linux/threads.h>#include <asm/irq.h>#include <asm/param.h>#include <kern_util.h>#include <os.h> void timer_handler(int sig, struct siginfo *unused_si, struct uml_pt_regs *regs){	unsigned long flags; 	local_irq_save(flags);	do_IRQ(TIMER_IRQ, regs);	local_irq_restore(flags);} static void itimer_set_mode(enum clock_event_mode mode,			    struct clock_event_device *evt){	switch (mode) {	case CLOCK_EVT_MODE_PERIODIC:		set_interval();		break; 	case CLOCK_EVT_MODE_SHUTDOWN:	case CLOCK_EVT_MODE_UNUSED:	case CLOCK_EVT_MODE_ONESHOT:		disable_timer();		break; 	case CLOCK_EVT_MODE_RESUME:		break;	}} static int itimer_next_event(unsigned long delta,			     struct clock_event_device *evt){	return timer_one_shot(delta + 1);} static struct clock_event_device itimer_clockevent = {	.name		= "itimer",	.rating		= 250,	.cpumask	= cpu_all_mask,	.features	= CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,	.set_mode	= itimer_set_mode,	.set_next_event = itimer_next_event,	.shift		= 32,	.irq		= 0,}; static irqreturn_t um_timer(int irq, void *dev){	(*itimer_clockevent.event_handler)(&itimer_clockevent); 	return IRQ_HANDLED;} static cycle_t itimer_read(struct clocksource *cs){	return os_nsecs() / 1000;} static struct clocksource itimer_clocksource = {	.name		= "itimer",	.rating		= 300,	.read		= itimer_read,	.mask		= CLOCKSOURCE_MASK(64),	.flags		= CLOCK_SOURCE_IS_CONTINUOUS,}; static void __init setup_itimer(void){	int err; 	err = request_irq(TIMER_IRQ, um_timer, 0, "timer", NULL);	if (err != 0)		printk(KERN_ERR "register_timer : request_irq failed - "		       "errno = %d\n", -err); 	itimer_clockevent.mult = div_sc(HZ, NSEC_PER_SEC, 32);	itimer_clockevent.max_delta_ns =		clockevent_delta2ns(60 * HZ, &itimer_clockevent);	itimer_clockevent.min_delta_ns =		clockevent_delta2ns(1, &itimer_clockevent);	err = clocksource_register_hz(&itimer_clocksource, USEC_PER_SEC);	if (err) {		printk(KERN_ERR "clocksource_register_hz returned %d\n", err);		return;	}	clockevents_register_device(&itimer_clockevent);} void read_persistent_clock(struct timespec *ts){	long long nsecs = os_nsecs(); 	set_normalized_timespec(ts, nsecs / NSEC_PER_SEC,				nsecs % NSEC_PER_SEC);} void __init time_init(void){	timer_init();	late_time_init = setup_itimer;}