Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 1 | /* |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 2 | * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * Licensed under the GPL |
| 4 | */ |
| 5 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 6 | #include "linux/clockchips.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 7 | #include "linux/interrupt.h" |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 8 | #include "linux/jiffies.h" |
| 9 | #include "linux/threads.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | #include "asm/irq.h" |
| 11 | #include "asm/param.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 | #include "kern_util.h" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | #include "os.h" |
| 14 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 15 | /* |
| 16 | * Scheduler clock - returns current time in nanosec units. |
| 17 | */ |
| 18 | unsigned long long sched_clock(void) |
| 19 | { |
| 20 | return (unsigned long long)jiffies_64 * (1000000000 / HZ); |
| 21 | } |
| 22 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | #ifdef CONFIG_UML_REAL_TIME_CLOCK |
Jeff Dike | b7ec15b | 2007-05-06 14:51:51 -0700 | [diff] [blame] | 24 | static unsigned long long prev_nsecs[NR_CPUS]; |
Jeff Dike | 490ba17 | 2007-02-10 01:44:12 -0800 | [diff] [blame] | 25 | static long long delta[NR_CPUS]; /* Deviation per interval */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | #endif |
| 27 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 28 | void timer_handler(int sig, struct uml_pt_regs *regs) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | { |
| 30 | unsigned long long ticks = 0; |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 31 | unsigned long flags; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 | #ifdef CONFIG_UML_REAL_TIME_CLOCK |
Jeff Dike | 490ba17 | 2007-02-10 01:44:12 -0800 | [diff] [blame] | 33 | int c = cpu(); |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 34 | if (prev_nsecs[c]) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 35 | /* We've had 1 tick */ |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 36 | unsigned long long nsecs = os_nsecs(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | |
Jeff Dike | 490ba17 | 2007-02-10 01:44:12 -0800 | [diff] [blame] | 38 | delta[c] += nsecs - prev_nsecs[c]; |
| 39 | prev_nsecs[c] = nsecs; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | |
| 41 | /* Protect against the host clock being set backwards */ |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 42 | if (delta[c] < 0) |
Jeff Dike | 490ba17 | 2007-02-10 01:44:12 -0800 | [diff] [blame] | 43 | delta[c] = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | |
Jeff Dike | 490ba17 | 2007-02-10 01:44:12 -0800 | [diff] [blame] | 45 | ticks += (delta[c] * HZ) / BILLION; |
| 46 | delta[c] -= (ticks * BILLION) / HZ; |
Jeff Dike | 872aaa6 | 2006-07-10 04:45:08 -0700 | [diff] [blame] | 47 | } |
Jeff Dike | 490ba17 | 2007-02-10 01:44:12 -0800 | [diff] [blame] | 48 | else prev_nsecs[c] = os_nsecs(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | #else |
Jeff Dike | 872aaa6 | 2006-07-10 04:45:08 -0700 | [diff] [blame] | 50 | ticks = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 51 | #endif |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 52 | |
| 53 | local_irq_save(flags); |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 54 | while (ticks > 0) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | do_IRQ(TIMER_IRQ, regs); |
| 56 | ticks--; |
| 57 | } |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 58 | local_irq_restore(flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | } |
| 60 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 61 | static void itimer_set_mode(enum clock_event_mode mode, |
| 62 | struct clock_event_device *evt) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 63 | { |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 64 | switch(mode) { |
| 65 | case CLOCK_EVT_MODE_PERIODIC: |
| 66 | set_interval(); |
| 67 | break; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 68 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 69 | case CLOCK_EVT_MODE_SHUTDOWN: |
| 70 | case CLOCK_EVT_MODE_UNUSED: |
| 71 | disable_timer(); |
| 72 | break; |
| 73 | case CLOCK_EVT_MODE_ONESHOT: |
| 74 | BUG(); |
| 75 | break; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 76 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 77 | case CLOCK_EVT_MODE_RESUME: |
| 78 | break; |
| 79 | } |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 80 | } |
| 81 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 82 | static struct clock_event_device itimer_clockevent = { |
| 83 | .name = "itimer", |
| 84 | .rating = 250, |
| 85 | .cpumask = CPU_MASK_ALL, |
| 86 | .features = CLOCK_EVT_FEAT_PERIODIC, |
| 87 | .set_mode = itimer_set_mode, |
| 88 | .set_next_event = NULL, |
| 89 | .shift = 32, |
| 90 | .irq = 0, |
| 91 | }; |
| 92 | |
| 93 | static irqreturn_t um_timer(int irq, void *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | { |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 95 | (*itimer_clockevent.event_handler)(&itimer_clockevent); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 96 | |
Jeff Dike | 572e614 | 2006-06-30 01:55:56 -0700 | [diff] [blame] | 97 | return IRQ_HANDLED; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 98 | } |
| 99 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 100 | static void __init setup_itimer(void) |
Jeff Dike | aceb343 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 101 | { |
| 102 | int err; |
| 103 | |
| 104 | err = request_irq(TIMER_IRQ, um_timer, IRQF_DISABLED, "timer", NULL); |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 105 | if (err != 0) |
Jeff Dike | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 106 | printk(KERN_ERR "register_timer : request_irq failed - " |
Jeff Dike | aceb343 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 107 | "errno = %d\n", -err); |
| 108 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 109 | itimer_clockevent.mult = div_sc(HZ, NSEC_PER_SEC, 32); |
| 110 | itimer_clockevent.max_delta_ns = |
| 111 | clockevent_delta2ns(60 * HZ, &itimer_clockevent); |
| 112 | itimer_clockevent.min_delta_ns = |
| 113 | clockevent_delta2ns(1, &itimer_clockevent); |
| 114 | clockevents_register_device(&itimer_clockevent); |
Jeff Dike | aceb343 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 115 | } |
| 116 | |
| 117 | extern void (*late_time_init)(void); |
| 118 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 119 | void __init time_init(void) |
Jeff Dike | aceb343 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 120 | { |
| 121 | long long nsecs; |
| 122 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 123 | timer_init(); |
| 124 | |
Jeff Dike | aceb343 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 125 | nsecs = os_nsecs(); |
| 126 | set_normalized_timespec(&wall_to_monotonic, -nsecs / BILLION, |
| 127 | -nsecs % BILLION); |
Jeff Dike | b7ec15b | 2007-05-06 14:51:51 -0700 | [diff] [blame] | 128 | set_normalized_timespec(&xtime, nsecs / BILLION, nsecs % BILLION); |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame^] | 129 | late_time_init = setup_itimer; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | } |