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 | c5d4bb1 | 2008-02-04 22:31:14 -0800 | [diff] [blame] | 6 | #include <linux/clockchips.h> |
Adrian Bunk | 7d195a5 | 2008-04-29 00:59:18 -0700 | [diff] [blame] | 7 | #include <linux/init.h> |
Jeff Dike | c5d4bb1 | 2008-02-04 22:31:14 -0800 | [diff] [blame] | 8 | #include <linux/interrupt.h> |
| 9 | #include <linux/jiffies.h> |
| 10 | #include <linux/threads.h> |
| 11 | #include <asm/irq.h> |
| 12 | #include <asm/param.h> |
Al Viro | 37185b3 | 2012-10-08 03:27:32 +0100 | [diff] [blame] | 13 | #include <kern_util.h> |
| 14 | #include <os.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 15 | |
Martin Pärtel | d3c1cfc | 2012-08-02 00:49:17 +0200 | [diff] [blame] | 16 | void timer_handler(int sig, struct siginfo *unused_si, struct uml_pt_regs *regs) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | { |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 18 | unsigned long flags; |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 19 | |
| 20 | local_irq_save(flags); |
Jeff Dike | d2753a6d | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 21 | do_IRQ(TIMER_IRQ, regs); |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 22 | local_irq_restore(flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | } |
| 24 | |
Viresh Kumar | 71b5280 | 2015-07-16 16:56:31 +0530 | [diff] [blame] | 25 | static int itimer_shutdown(struct clock_event_device *evt) |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 26 | { |
Viresh Kumar | 71b5280 | 2015-07-16 16:56:31 +0530 | [diff] [blame] | 27 | disable_timer(); |
| 28 | return 0; |
| 29 | } |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 30 | |
Viresh Kumar | 71b5280 | 2015-07-16 16:56:31 +0530 | [diff] [blame] | 31 | static int itimer_set_periodic(struct clock_event_device *evt) |
| 32 | { |
| 33 | set_interval(); |
| 34 | return 0; |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 35 | } |
| 36 | |
Jeff Dike | d2753a6d | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 37 | static int itimer_next_event(unsigned long delta, |
| 38 | struct clock_event_device *evt) |
| 39 | { |
| 40 | return timer_one_shot(delta + 1); |
| 41 | } |
| 42 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 43 | static struct clock_event_device itimer_clockevent = { |
Viresh Kumar | 71b5280 | 2015-07-16 16:56:31 +0530 | [diff] [blame] | 44 | .name = "itimer", |
| 45 | .rating = 250, |
| 46 | .cpumask = cpu_all_mask, |
| 47 | .features = CLOCK_EVT_FEAT_PERIODIC | |
| 48 | CLOCK_EVT_FEAT_ONESHOT, |
| 49 | .set_state_shutdown = itimer_shutdown, |
| 50 | .set_state_periodic = itimer_set_periodic, |
| 51 | .set_state_oneshot = itimer_shutdown, |
| 52 | .set_next_event = itimer_next_event, |
| 53 | .shift = 32, |
| 54 | .irq = 0, |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 55 | }; |
| 56 | |
| 57 | static irqreturn_t um_timer(int irq, void *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | { |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 59 | (*itimer_clockevent.event_handler)(&itimer_clockevent); |
Gennady Sharapov | cff65c4 | 2006-01-18 17:42:42 -0800 | [diff] [blame] | 60 | |
Jeff Dike | 572e614 | 2006-06-30 01:55:56 -0700 | [diff] [blame] | 61 | return IRQ_HANDLED; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | } |
| 63 | |
Magnus Damm | 8e19608 | 2009-04-21 12:24:00 -0700 | [diff] [blame] | 64 | static cycle_t itimer_read(struct clocksource *cs) |
Jeff Dike | 791a644 | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 65 | { |
Jeff Dike | cfd28f6 | 2008-05-12 14:01:53 -0700 | [diff] [blame] | 66 | return os_nsecs() / 1000; |
Jeff Dike | 791a644 | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 67 | } |
| 68 | |
| 69 | static struct clocksource itimer_clocksource = { |
| 70 | .name = "itimer", |
| 71 | .rating = 300, |
| 72 | .read = itimer_read, |
| 73 | .mask = CLOCKSOURCE_MASK(64), |
Jeff Dike | 791a644 | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 74 | .flags = CLOCK_SOURCE_IS_CONTINUOUS, |
| 75 | }; |
| 76 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 77 | static void __init setup_itimer(void) |
Jeff Dike | aceb3434 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 78 | { |
| 79 | int err; |
| 80 | |
Yong Zhang | c0b79a9 | 2011-09-22 16:58:46 +0800 | [diff] [blame] | 81 | err = request_irq(TIMER_IRQ, um_timer, 0, "timer", NULL); |
Jeff Dike | ba180fd | 2007-10-16 01:27:00 -0700 | [diff] [blame] | 82 | if (err != 0) |
Jeff Dike | 537ae94 | 2006-09-25 23:33:05 -0700 | [diff] [blame] | 83 | printk(KERN_ERR "register_timer : request_irq failed - " |
Jeff Dike | aceb3434 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 84 | "errno = %d\n", -err); |
| 85 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 86 | itimer_clockevent.mult = div_sc(HZ, NSEC_PER_SEC, 32); |
| 87 | itimer_clockevent.max_delta_ns = |
| 88 | clockevent_delta2ns(60 * HZ, &itimer_clockevent); |
| 89 | itimer_clockevent.min_delta_ns = |
| 90 | clockevent_delta2ns(1, &itimer_clockevent); |
John Stultz | 60d687e | 2010-04-26 20:25:16 -0700 | [diff] [blame] | 91 | err = clocksource_register_hz(&itimer_clocksource, USEC_PER_SEC); |
Jeff Dike | 791a644 | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 92 | if (err) { |
John Stultz | 60d687e | 2010-04-26 20:25:16 -0700 | [diff] [blame] | 93 | printk(KERN_ERR "clocksource_register_hz returned %d\n", err); |
Jeff Dike | 791a644 | 2007-10-16 01:27:25 -0700 | [diff] [blame] | 94 | return; |
| 95 | } |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 96 | clockevents_register_device(&itimer_clockevent); |
Jeff Dike | aceb3434 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 97 | } |
| 98 | |
John Stultz | 9f31f57 | 2010-07-13 17:56:24 -0700 | [diff] [blame] | 99 | void read_persistent_clock(struct timespec *ts) |
| 100 | { |
Thomas Gleixner | b292307 | 2010-08-03 20:34:48 +0200 | [diff] [blame] | 101 | long long nsecs = os_nsecs(); |
| 102 | |
John Stultz | 9f31f57 | 2010-07-13 17:56:24 -0700 | [diff] [blame] | 103 | set_normalized_timespec(ts, nsecs / NSEC_PER_SEC, |
| 104 | nsecs % NSEC_PER_SEC); |
| 105 | } |
| 106 | |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 107 | void __init time_init(void) |
Jeff Dike | aceb3434 | 2006-07-10 04:45:05 -0700 | [diff] [blame] | 108 | { |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 109 | timer_init(); |
Jeff Dike | 31ccc1f | 2007-10-16 01:27:24 -0700 | [diff] [blame] | 110 | late_time_init = setup_itimer; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 | } |