| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 1 | /* | 
| Dave Jones | 835c34a | 2007-10-12 21:10:53 -0400 | [diff] [blame] | 2 | * 8253/PIT functions | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 3 | * | 
|  | 4 | */ | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 5 | #include <linux/clockchips.h> | 
| Thomas Gleixner | 18de5bc | 2007-07-21 04:37:34 -0700 | [diff] [blame] | 6 | #include <linux/interrupt.h> | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 7 | #include <linux/spinlock.h> | 
| Thomas Gleixner | 18de5bc | 2007-07-21 04:37:34 -0700 | [diff] [blame] | 8 | #include <linux/jiffies.h> | 
|  | 9 | #include <linux/module.h> | 
| Arnd Bergmann | 08604bd | 2009-06-16 15:31:12 -0700 | [diff] [blame] | 10 | #include <linux/timex.h> | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 11 | #include <linux/delay.h> | 
|  | 12 | #include <linux/init.h> | 
|  | 13 | #include <linux/io.h> | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 14 |  | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 15 | #include <asm/i8253.h> | 
| Thomas Gleixner | 4713e22c | 2008-01-30 13:30:02 +0100 | [diff] [blame] | 16 | #include <asm/hpet.h> | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 17 | #include <asm/smp.h> | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 18 |  | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 19 | DEFINE_RAW_SPINLOCK(i8253_lock); | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 20 | EXPORT_SYMBOL(i8253_lock); | 
|  | 21 |  | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 22 | /* | 
|  | 23 | * HPET replaces the PIT, when enabled. So we need to know, which of | 
|  | 24 | * the two timers is used | 
|  | 25 | */ | 
|  | 26 | struct clock_event_device *global_clock_event; | 
|  | 27 |  | 
|  | 28 | /* | 
|  | 29 | * Initialize the PIT timer. | 
|  | 30 | * | 
|  | 31 | * This is also called after resume to bring the PIT into operation again. | 
|  | 32 | */ | 
|  | 33 | static void init_pit_timer(enum clock_event_mode mode, | 
|  | 34 | struct clock_event_device *evt) | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 35 | { | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 36 | raw_spin_lock(&i8253_lock); | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 37 |  | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 38 | switch (mode) { | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 39 | case CLOCK_EVT_MODE_PERIODIC: | 
|  | 40 | /* binary, mode 2, LSB/MSB, ch 0 */ | 
| Alan Cox | 466eed2 | 2008-01-30 13:33:14 +0100 | [diff] [blame] | 41 | outb_pit(0x34, PIT_MODE); | 
|  | 42 | outb_pit(LATCH & 0xff , PIT_CH0);	/* LSB */ | 
|  | 43 | outb_pit(LATCH >> 8 , PIT_CH0);		/* MSB */ | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 44 | break; | 
|  | 45 |  | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 46 | case CLOCK_EVT_MODE_SHUTDOWN: | 
|  | 47 | case CLOCK_EVT_MODE_UNUSED: | 
| Thomas Gleixner | 7671988 | 2007-07-21 04:37:38 -0700 | [diff] [blame] | 48 | if (evt->mode == CLOCK_EVT_MODE_PERIODIC || | 
|  | 49 | evt->mode == CLOCK_EVT_MODE_ONESHOT) { | 
| Alan Cox | 466eed2 | 2008-01-30 13:33:14 +0100 | [diff] [blame] | 50 | outb_pit(0x30, PIT_MODE); | 
|  | 51 | outb_pit(0, PIT_CH0); | 
|  | 52 | outb_pit(0, PIT_CH0); | 
| Thomas Gleixner | 7671988 | 2007-07-21 04:37:38 -0700 | [diff] [blame] | 53 | } | 
| Thomas Gleixner | 18de5bc | 2007-07-21 04:37:34 -0700 | [diff] [blame] | 54 | break; | 
|  | 55 |  | 
| Thomas Gleixner | 6b3964c | 2007-03-22 22:46:18 +0100 | [diff] [blame] | 56 | case CLOCK_EVT_MODE_ONESHOT: | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 57 | /* One shot setup */ | 
| Alan Cox | 466eed2 | 2008-01-30 13:33:14 +0100 | [diff] [blame] | 58 | outb_pit(0x38, PIT_MODE); | 
| Thomas Gleixner | 18de5bc | 2007-07-21 04:37:34 -0700 | [diff] [blame] | 59 | break; | 
|  | 60 |  | 
|  | 61 | case CLOCK_EVT_MODE_RESUME: | 
|  | 62 | /* Nothing to do here */ | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 63 | break; | 
|  | 64 | } | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 65 | raw_spin_unlock(&i8253_lock); | 
| john stultz | 8d016ef | 2006-06-26 00:25:09 -0700 | [diff] [blame] | 66 | } | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 67 |  | 
|  | 68 | /* | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 69 | * Program the next event in oneshot mode | 
|  | 70 | * | 
|  | 71 | * Delta is given in PIT ticks | 
|  | 72 | */ | 
|  | 73 | static int pit_next_event(unsigned long delta, struct clock_event_device *evt) | 
|  | 74 | { | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 75 | raw_spin_lock(&i8253_lock); | 
| Alan Cox | 466eed2 | 2008-01-30 13:33:14 +0100 | [diff] [blame] | 76 | outb_pit(delta & 0xff , PIT_CH0);	/* LSB */ | 
|  | 77 | outb_pit(delta >> 8 , PIT_CH0);		/* MSB */ | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 78 | raw_spin_unlock(&i8253_lock); | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 79 |  | 
|  | 80 | return 0; | 
|  | 81 | } | 
|  | 82 |  | 
|  | 83 | /* | 
|  | 84 | * On UP the PIT can serve all of the possible timer functions. On SMP systems | 
|  | 85 | * it can be solely used for the global tick. | 
|  | 86 | * | 
| Simon Arlott | 27b46d7 | 2007-10-20 01:13:56 +0200 | [diff] [blame] | 87 | * The profiling and update capabilities are switched off once the local apic is | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 88 | * registered. This mechanism replaces the previous #ifdef LOCAL_APIC - | 
|  | 89 | * !using_apic_timer decisions in do_timer_interrupt_hook() | 
|  | 90 | */ | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 91 | static struct clock_event_device pit_ce = { | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 92 | .name		= "pit", | 
|  | 93 | .features	= CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT, | 
|  | 94 | .set_mode	= init_pit_timer, | 
|  | 95 | .set_next_event = pit_next_event, | 
|  | 96 | .shift		= 32, | 
|  | 97 | .irq		= 0, | 
|  | 98 | }; | 
|  | 99 |  | 
|  | 100 | /* | 
|  | 101 | * Initialize the conversion factor and the min/max deltas of the clock event | 
|  | 102 | * structure and register the clock event source with the framework. | 
|  | 103 | */ | 
|  | 104 | void __init setup_pit_timer(void) | 
|  | 105 | { | 
|  | 106 | /* | 
|  | 107 | * Start pit with the boot cpu mask and make it global after the | 
|  | 108 | * IO_APIC has been initialized. | 
|  | 109 | */ | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 110 | pit_ce.cpumask = cpumask_of(smp_processor_id()); | 
|  | 111 | pit_ce.mult = div_sc(CLOCK_TICK_RATE, NSEC_PER_SEC, pit_ce.shift); | 
|  | 112 | pit_ce.max_delta_ns = clockevent_delta2ns(0x7FFF, &pit_ce); | 
|  | 113 | pit_ce.min_delta_ns = clockevent_delta2ns(0xF, &pit_ce); | 
|  | 114 |  | 
|  | 115 | clockevents_register_device(&pit_ce); | 
|  | 116 | global_clock_event = &pit_ce; | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 117 | } | 
|  | 118 |  | 
| Thomas Gleixner | f5e0e93 | 2007-10-12 23:04:06 +0200 | [diff] [blame] | 119 | #ifndef CONFIG_X86_64 | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 120 | /* | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 121 | * Since the PIT overflows every tick, its not very useful | 
|  | 122 | * to just read by itself. So use jiffies to emulate a free | 
|  | 123 | * running counter: | 
|  | 124 | */ | 
| Magnus Damm | 8e19608 | 2009-04-21 12:24:00 -0700 | [diff] [blame] | 125 | static cycle_t pit_read(struct clocksource *cs) | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 126 | { | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 127 | static int old_count; | 
|  | 128 | static u32 old_jifs; | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 129 | unsigned long flags; | 
|  | 130 | int count; | 
| john stultz | 6415ce9 | 2006-06-26 00:25:16 -0700 | [diff] [blame] | 131 | u32 jifs; | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 132 |  | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 133 | raw_spin_lock_irqsave(&i8253_lock, flags); | 
| Thomas Gleixner | e9e2cdb | 2007-02-16 01:28:04 -0800 | [diff] [blame] | 134 | /* | 
| john stultz | 6415ce9 | 2006-06-26 00:25:16 -0700 | [diff] [blame] | 135 | * Although our caller may have the read side of xtime_lock, | 
|  | 136 | * this is now a seqlock, and we are cheating in this routine | 
|  | 137 | * by having side effects on state that we cannot undo if | 
|  | 138 | * there is a collision on the seqlock and our caller has to | 
|  | 139 | * retry.  (Namely, old_jifs and old_count.)  So we must treat | 
|  | 140 | * jiffies as volatile despite the lock.  We read jiffies | 
|  | 141 | * before latching the timer count to guarantee that although | 
|  | 142 | * the jiffies value might be older than the count (that is, | 
|  | 143 | * the counter may underflow between the last point where | 
|  | 144 | * jiffies was incremented and the point where we latch the | 
|  | 145 | * count), it cannot be newer. | 
|  | 146 | */ | 
|  | 147 | jifs = jiffies; | 
| Alan Cox | 466eed2 | 2008-01-30 13:33:14 +0100 | [diff] [blame] | 148 | outb_pit(0x00, PIT_MODE);	/* latch the count ASAP */ | 
|  | 149 | count = inb_pit(PIT_CH0);	/* read the latched count */ | 
|  | 150 | count |= inb_pit(PIT_CH0) << 8; | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 151 |  | 
|  | 152 | /* VIA686a test code... reset the latch if count > max + 1 */ | 
|  | 153 | if (count > LATCH) { | 
| Alan Cox | 466eed2 | 2008-01-30 13:33:14 +0100 | [diff] [blame] | 154 | outb_pit(0x34, PIT_MODE); | 
|  | 155 | outb_pit(LATCH & 0xff, PIT_CH0); | 
|  | 156 | outb_pit(LATCH >> 8, PIT_CH0); | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 157 | count = LATCH - 1; | 
|  | 158 | } | 
| john stultz | 6415ce9 | 2006-06-26 00:25:16 -0700 | [diff] [blame] | 159 |  | 
|  | 160 | /* | 
|  | 161 | * It's possible for count to appear to go the wrong way for a | 
|  | 162 | * couple of reasons: | 
|  | 163 | * | 
|  | 164 | *  1. The timer counter underflows, but we haven't handled the | 
|  | 165 | *     resulting interrupt and incremented jiffies yet. | 
|  | 166 | *  2. Hardware problem with the timer, not giving us continuous time, | 
|  | 167 | *     the counter does small "jumps" upwards on some Pentium systems, | 
|  | 168 | *     (see c't 95/10 page 335 for Neptun bug.) | 
|  | 169 | * | 
|  | 170 | * Previous attempts to handle these cases intelligently were | 
|  | 171 | * buggy, so we just do the simple thing now. | 
|  | 172 | */ | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 173 | if (count > old_count && jifs == old_jifs) | 
| john stultz | 6415ce9 | 2006-06-26 00:25:16 -0700 | [diff] [blame] | 174 | count = old_count; | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 175 |  | 
| john stultz | 6415ce9 | 2006-06-26 00:25:16 -0700 | [diff] [blame] | 176 | old_count = count; | 
|  | 177 | old_jifs = jifs; | 
|  | 178 |  | 
| Thomas Gleixner | ced918e | 2010-02-17 16:47:10 +0000 | [diff] [blame] | 179 | raw_spin_unlock_irqrestore(&i8253_lock, flags); | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 180 |  | 
| john stultz | 6415ce9 | 2006-06-26 00:25:16 -0700 | [diff] [blame] | 181 | count = (LATCH - 1) - count; | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 182 |  | 
|  | 183 | return (cycle_t)(jifs * LATCH) + count; | 
|  | 184 | } | 
|  | 185 |  | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 186 | static struct clocksource pit_cs = { | 
|  | 187 | .name		= "pit", | 
|  | 188 | .rating		= 110, | 
|  | 189 | .read		= pit_read, | 
|  | 190 | .mask		= CLOCKSOURCE_MASK(32), | 
|  | 191 | .mult		= 0, | 
|  | 192 | .shift		= 20, | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 193 | }; | 
|  | 194 |  | 
|  | 195 | static int __init init_pit_clocksource(void) | 
|  | 196 | { | 
| Thomas Gleixner | 316da3b | 2008-01-30 13:30:02 +0100 | [diff] [blame] | 197 | /* | 
|  | 198 | * Several reasons not to register PIT as a clocksource: | 
|  | 199 | * | 
|  | 200 | * - On SMP PIT does not scale due to i8253_lock | 
|  | 201 | * - when HPET is enabled | 
|  | 202 | * - when local APIC timer is active (PIT is switched off) | 
|  | 203 | */ | 
|  | 204 | if (num_possible_cpus() > 1 || is_hpet_enabled() || | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 205 | pit_ce.mode != CLOCK_EVT_MODE_PERIODIC) | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 206 | return 0; | 
|  | 207 |  | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 208 | pit_cs.mult = clocksource_hz2mult(CLOCK_TICK_RATE, pit_cs.shift); | 
|  | 209 |  | 
|  | 210 | return clocksource_register(&pit_cs); | 
| john stultz | 5d0cf41 | 2006-06-26 00:25:12 -0700 | [diff] [blame] | 211 | } | 
| john stultz | 6bb74df | 2007-03-05 00:30:50 -0800 | [diff] [blame] | 212 | arch_initcall(init_pit_clocksource); | 
| Thomas Gleixner | f5e0e93 | 2007-10-12 23:04:06 +0200 | [diff] [blame] | 213 |  | 
| Jaswinder Singh Rajput | c8344bc | 2009-03-21 16:56:10 +0530 | [diff] [blame] | 214 | #endif /* !CONFIG_X86_64 */ |