Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 | /* * 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 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), .mult = 1000, .shift = 0, .flags = CLOCK_SOURCE_IS_CONTINUOUS, }; static void __init setup_itimer(void) { int err; err = request_irq(TIMER_IRQ, um_timer, IRQF_DISABLED, "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(&itimer_clocksource); if (err) { printk(KERN_ERR "clocksource_register 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; } |