time.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:21k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/arch/i386/kernel/time.c
  3.  *
  4.  *  Copyright (C) 1991, 1992, 1995  Linus Torvalds
  5.  *
  6.  * This file contains the PC-specific time handling details:
  7.  * reading the RTC at bootup, etc..
  8.  * 1994-07-02    Alan Modra
  9.  * fixed set_rtc_mmss, fixed time.year for >= 2000, new mktime
  10.  * 1995-03-26    Markus Kuhn
  11.  *      fixed 500 ms bug at call to set_rtc_mmss, fixed DS12887
  12.  *      precision CMOS clock update
  13.  * 1996-05-03    Ingo Molnar
  14.  *      fixed time warps in do_[slow|fast]_gettimeoffset()
  15.  * 1997-09-10 Updated NTP code according to technical memorandum Jan '96
  16.  * "A Kernel Model for Precision Timekeeping" by Dave Mills
  17.  * 1998-09-05    (Various)
  18.  * More robust do_fast_gettimeoffset() algorithm implemented
  19.  * (works with APM, Cyrix 6x86MX and Centaur C6),
  20.  * monotonic gettimeofday() with fast_get_timeoffset(),
  21.  * drift-proof precision TSC calibration on boot
  22.  * (C. Scott Ananian <cananian@alumni.princeton.edu>, Andrew D.
  23.  * Balsa <andrebalsa@altern.org>, Philip Gladstone <philip@raptor.com>;
  24.  * ported from 2.0.35 Jumbo-9 by Michael Krause <m.krause@tu-harburg.de>).
  25.  * 1998-12-16    Andrea Arcangeli
  26.  * Fixed Jumbo-9 code in 2.1.131: do_gettimeofday was missing 1 jiffy
  27.  * because was not accounting lost_ticks.
  28.  * 1998-12-24 Copyright (C) 1998  Andrea Arcangeli
  29.  * Fixed a xtime SMP race (we need the xtime_lock rw spinlock to
  30.  * serialize accesses to xtime/lost_ticks).
  31.  */
  32. #include <linux/errno.h>
  33. #include <linux/module.h>
  34. #include <linux/sched.h>
  35. #include <linux/kernel.h>
  36. #include <linux/param.h>
  37. #include <linux/string.h>
  38. #include <linux/mm.h>
  39. #include <linux/interrupt.h>
  40. #include <linux/time.h>
  41. #include <linux/delay.h>
  42. #include <linux/init.h>
  43. #include <linux/smp.h>
  44. #include <asm/io.h>
  45. #include <asm/smp.h>
  46. #include <asm/irq.h>
  47. #include <asm/msr.h>
  48. #include <asm/delay.h>
  49. #include <asm/mpspec.h>
  50. #include <asm/uaccess.h>
  51. #include <asm/processor.h>
  52. #include <linux/mc146818rtc.h>
  53. #include <linux/timex.h>
  54. #include <linux/config.h>
  55. #include <asm/fixmap.h>
  56. #include <asm/cobalt.h>
  57. /*
  58.  * for x86_do_profile()
  59.  */
  60. #include <linux/irq.h>
  61. unsigned long cpu_khz; /* Detected as we calibrate the TSC */
  62. /* Number of usecs that the last interrupt was delayed */
  63. static int delay_at_last_interrupt;
  64. static unsigned long last_tsc_low; /* lsb 32 bits of Time Stamp Counter */
  65. /* Cached *multiplier* to convert TSC counts to microseconds.
  66.  * (see the equation below).
  67.  * Equal to 2^32 * (1 / (clocks per usec) ).
  68.  * Initialized in time_init.
  69.  */
  70. unsigned long fast_gettimeoffset_quotient;
  71. extern rwlock_t xtime_lock;
  72. extern unsigned long wall_jiffies;
  73. spinlock_t rtc_lock = SPIN_LOCK_UNLOCKED;
  74. static inline unsigned long do_fast_gettimeoffset(void)
  75. {
  76. register unsigned long eax, edx;
  77. /* Read the Time Stamp Counter */
  78. rdtsc(eax,edx);
  79. /* .. relative to previous jiffy (32 bits is enough) */
  80. eax -= last_tsc_low; /* tsc_low delta */
  81. /*
  82.          * Time offset = (tsc_low delta) * fast_gettimeoffset_quotient
  83.          *             = (tsc_low delta) * (usecs_per_clock)
  84.          *             = (tsc_low delta) * (usecs_per_jiffy / clocks_per_jiffy)
  85.  *
  86.  * Using a mull instead of a divl saves up to 31 clock cycles
  87.  * in the critical path.
  88.          */
  89. __asm__("mull %2"
  90. :"=a" (eax), "=d" (edx)
  91. :"rm" (fast_gettimeoffset_quotient),
  92.  "0" (eax));
  93. /* our adjusted time offset in microseconds */
  94. return delay_at_last_interrupt + edx;
  95. }
  96. #define TICK_SIZE tick
  97. spinlock_t i8253_lock = SPIN_LOCK_UNLOCKED;
  98. EXPORT_SYMBOL(i8253_lock);
  99. extern spinlock_t i8259A_lock;
  100. #ifndef CONFIG_X86_TSC
  101. /* This function must be called with interrupts disabled 
  102.  * It was inspired by Steve McCanne's microtime-i386 for BSD.  -- jrs
  103.  * 
  104.  * However, the pc-audio speaker driver changes the divisor so that
  105.  * it gets interrupted rather more often - it loads 64 into the
  106.  * counter rather than 11932! This has an adverse impact on
  107.  * do_gettimeoffset() -- it stops working! What is also not
  108.  * good is that the interval that our timer function gets called
  109.  * is no longer 10.0002 ms, but 9.9767 ms. To get around this
  110.  * would require using a different timing source. Maybe someone
  111.  * could use the RTC - I know that this can interrupt at frequencies
  112.  * ranging from 8192Hz to 2Hz. If I had the energy, I'd somehow fix
  113.  * it so that at startup, the timer code in sched.c would select
  114.  * using either the RTC or the 8253 timer. The decision would be
  115.  * based on whether there was any other device around that needed
  116.  * to trample on the 8253. I'd set up the RTC to interrupt at 1024 Hz,
  117.  * and then do some jiggery to have a version of do_timer that 
  118.  * advanced the clock by 1/1024 s. Every time that reached over 1/100
  119.  * of a second, then do all the old code. If the time was kept correct
  120.  * then do_gettimeoffset could just return 0 - there is no low order
  121.  * divider that can be accessed.
  122.  *
  123.  * Ideally, you would be able to use the RTC for the speaker driver,
  124.  * but it appears that the speaker driver really needs interrupt more
  125.  * often than every 120 us or so.
  126.  *
  127.  * Anyway, this needs more thought.... pjsg (1993-08-28)
  128.  * 
  129.  * If you are really that interested, you should be reading
  130.  * comp.protocols.time.ntp!
  131.  */
  132. static unsigned long do_slow_gettimeoffset(void)
  133. {
  134. int count;
  135. static int count_p = LATCH;    /* for the first call after boot */
  136. static unsigned long jiffies_p = 0;
  137. /*
  138.  * cache volatile jiffies temporarily; we have IRQs turned off. 
  139.  */
  140. unsigned long jiffies_t;
  141. /* gets recalled with irq locally disabled */
  142. spin_lock(&i8253_lock);
  143. /* timer count may underflow right here */
  144. outb_p(0x00, 0x43); /* latch the count ASAP */
  145. count = inb_p(0x40); /* read the latched count */
  146. /*
  147.  * We do this guaranteed double memory access instead of a _p 
  148.  * postfix in the previous port access. Wheee, hackady hack
  149.  */
  150.   jiffies_t = jiffies;
  151. count |= inb_p(0x40) << 8;
  152.         /* VIA686a test code... reset the latch if count > max + 1 */
  153.         if (count > LATCH) {
  154.                 outb_p(0x34, 0x43);
  155.                 outb_p(LATCH & 0xff, 0x40);
  156.                 outb(LATCH >> 8, 0x40);
  157.                 count = LATCH - 1;
  158.         }
  159. spin_unlock(&i8253_lock);
  160. /*
  161.  * avoiding timer inconsistencies (they are rare, but they happen)...
  162.  * there are two kinds of problems that must be avoided here:
  163.  *  1. the timer counter underflows
  164.  *  2. hardware problem with the timer, not giving us continuous time,
  165.  *     the counter does small "jumps" upwards on some Pentium systems,
  166.  *     (see c't 95/10 page 335 for Neptun bug.)
  167.  */
  168. /* you can safely undefine this if you don't have the Neptune chipset */
  169. #define BUGGY_NEPTUN_TIMER
  170. if( jiffies_t == jiffies_p ) {
  171. if( count > count_p ) {
  172. /* the nutcase */
  173. int i;
  174. spin_lock(&i8259A_lock);
  175. /*
  176.  * This is tricky when I/O APICs are used;
  177.  * see do_timer_interrupt().
  178.  */
  179. i = inb(0x20);
  180. spin_unlock(&i8259A_lock);
  181. /* assumption about timer being IRQ0 */
  182. if (i & 0x01) {
  183. /*
  184.  * We cannot detect lost timer interrupts ... 
  185.  * well, that's why we call them lost, don't we? :)
  186.  * [hmm, on the Pentium and Alpha we can ... sort of]
  187.  */
  188. count -= LATCH;
  189. } else {
  190. #ifdef BUGGY_NEPTUN_TIMER
  191. /*
  192.  * for the Neptun bug we know that the 'latch'
  193.  * command doesnt latch the high and low value
  194.  * of the counter atomically. Thus we have to 
  195.  * substract 256 from the counter 
  196.  * ... funny, isnt it? :)
  197.  */
  198. count -= 256;
  199. #else
  200. printk("do_slow_gettimeoffset(): hardware timer problem?n");
  201. #endif
  202. }
  203. }
  204. } else
  205. jiffies_p = jiffies_t;
  206. count_p = count;
  207. count = ((LATCH-1) - count) * TICK_SIZE;
  208. count = (count + LATCH/2) / LATCH;
  209. return count;
  210. }
  211. static unsigned long (*do_gettimeoffset)(void) = do_slow_gettimeoffset;
  212. #else
  213. #define do_gettimeoffset() do_fast_gettimeoffset()
  214. #endif
  215. /*
  216.  * This version of gettimeofday has microsecond resolution
  217.  * and better than microsecond precision on fast x86 machines with TSC.
  218.  */
  219. void do_gettimeofday(struct timeval *tv)
  220. {
  221. unsigned long flags;
  222. unsigned long usec, sec;
  223. read_lock_irqsave(&xtime_lock, flags);
  224. usec = do_gettimeoffset();
  225. {
  226. unsigned long lost = jiffies - wall_jiffies;
  227. if (lost)
  228. usec += lost * (1000000 / HZ);
  229. }
  230. sec = xtime.tv_sec;
  231. usec += xtime.tv_usec;
  232. read_unlock_irqrestore(&xtime_lock, flags);
  233. while (usec >= 1000000) {
  234. usec -= 1000000;
  235. sec++;
  236. }
  237. tv->tv_sec = sec;
  238. tv->tv_usec = usec;
  239. }
  240. void do_settimeofday(struct timeval *tv)
  241. {
  242. write_lock_irq(&xtime_lock);
  243. /*
  244.  * This is revolting. We need to set "xtime" correctly. However, the
  245.  * value in this location is the value at the most recent update of
  246.  * wall time.  Discover what correction gettimeofday() would have
  247.  * made, and then undo it!
  248.  */
  249. tv->tv_usec -= do_gettimeoffset();
  250. tv->tv_usec -= (jiffies - wall_jiffies) * (1000000 / HZ);
  251. while (tv->tv_usec < 0) {
  252. tv->tv_usec += 1000000;
  253. tv->tv_sec--;
  254. }
  255. xtime = *tv;
  256. time_adjust = 0; /* stop active adjtime() */
  257. time_status |= STA_UNSYNC;
  258. time_maxerror = NTP_PHASE_LIMIT;
  259. time_esterror = NTP_PHASE_LIMIT;
  260. write_unlock_irq(&xtime_lock);
  261. }
  262. /*
  263.  * In order to set the CMOS clock precisely, set_rtc_mmss has to be
  264.  * called 500 ms after the second nowtime has started, because when
  265.  * nowtime is written into the registers of the CMOS clock, it will
  266.  * jump to the next second precisely 500 ms later. Check the Motorola
  267.  * MC146818A or Dallas DS12887 data sheet for details.
  268.  *
  269.  * BUG: This routine does not handle hour overflow properly; it just
  270.  *      sets the minutes. Usually you'll only notice that after reboot!
  271.  */
  272. static int set_rtc_mmss(unsigned long nowtime)
  273. {
  274. int retval = 0;
  275. int real_seconds, real_minutes, cmos_minutes;
  276. unsigned char save_control, save_freq_select;
  277. /* gets recalled with irq locally disabled */
  278. spin_lock(&rtc_lock);
  279. save_control = CMOS_READ(RTC_CONTROL); /* tell the clock it's being set */
  280. CMOS_WRITE((save_control|RTC_SET), RTC_CONTROL);
  281. save_freq_select = CMOS_READ(RTC_FREQ_SELECT); /* stop and reset prescaler */
  282. CMOS_WRITE((save_freq_select|RTC_DIV_RESET2), RTC_FREQ_SELECT);
  283. cmos_minutes = CMOS_READ(RTC_MINUTES);
  284. if (!(save_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD)
  285. BCD_TO_BIN(cmos_minutes);
  286. /*
  287.  * since we're only adjusting minutes and seconds,
  288.  * don't interfere with hour overflow. This avoids
  289.  * messing with unknown time zones but requires your
  290.  * RTC not to be off by more than 15 minutes
  291.  */
  292. real_seconds = nowtime % 60;
  293. real_minutes = nowtime / 60;
  294. if (((abs(real_minutes - cmos_minutes) + 15)/30) & 1)
  295. real_minutes += 30; /* correct for half hour time zone */
  296. real_minutes %= 60;
  297. if (abs(real_minutes - cmos_minutes) < 30) {
  298. if (!(save_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD) {
  299. BIN_TO_BCD(real_seconds);
  300. BIN_TO_BCD(real_minutes);
  301. }
  302. CMOS_WRITE(real_seconds,RTC_SECONDS);
  303. CMOS_WRITE(real_minutes,RTC_MINUTES);
  304. } else {
  305. printk(KERN_WARNING
  306.        "set_rtc_mmss: can't update from %d to %dn",
  307.        cmos_minutes, real_minutes);
  308. retval = -1;
  309. }
  310. /* The following flags have to be released exactly in this order,
  311.  * otherwise the DS12887 (popular MC146818A clone with integrated
  312.  * battery and quartz) will not reset the oscillator and will not
  313.  * update precisely 500 ms later. You won't find this mentioned in
  314.  * the Dallas Semiconductor data sheets, but who believes data
  315.  * sheets anyway ...                           -- Markus Kuhn
  316.  */
  317. CMOS_WRITE(save_control, RTC_CONTROL);
  318. CMOS_WRITE(save_freq_select, RTC_FREQ_SELECT);
  319. spin_unlock(&rtc_lock);
  320. return retval;
  321. }
  322. /* last time the cmos clock got updated */
  323. static long last_rtc_update;
  324. int timer_ack;
  325. /*
  326.  * timer_interrupt() needs to keep up the real-time clock,
  327.  * as well as call the "do_timer()" routine every clocktick
  328.  */
  329. static inline void do_timer_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  330. {
  331. #ifdef CONFIG_X86_IO_APIC
  332. if (timer_ack) {
  333. /*
  334.  * Subtle, when I/O APICs are used we have to ack timer IRQ
  335.  * manually to reset the IRR bit for do_slow_gettimeoffset().
  336.  * This will also deassert NMI lines for the watchdog if run
  337.  * on an 82489DX-based system.
  338.  */
  339. spin_lock(&i8259A_lock);
  340. outb(0x0c, 0x20);
  341. /* Ack the IRQ; AEOI will end it automatically. */
  342. inb(0x20);
  343. spin_unlock(&i8259A_lock);
  344. }
  345. #endif
  346. #ifdef CONFIG_VISWS
  347. /* Clear the interrupt */
  348. co_cpu_write(CO_CPU_STAT,co_cpu_read(CO_CPU_STAT) & ~CO_STAT_TIMEINTR);
  349. #endif
  350. do_timer(regs);
  351. /*
  352.  * In the SMP case we use the local APIC timer interrupt to do the
  353.  * profiling, except when we simulate SMP mode on a uniprocessor
  354.  * system, in that case we have to call the local interrupt handler.
  355.  */
  356. #ifndef CONFIG_X86_LOCAL_APIC
  357. if (!user_mode(regs))
  358. x86_do_profile(regs->eip);
  359. #else
  360. if (!using_apic_timer)
  361. smp_local_timer_interrupt(regs);
  362. #endif
  363. /*
  364.  * If we have an externally synchronized Linux clock, then update
  365.  * CMOS clock accordingly every ~11 minutes. Set_rtc_mmss() has to be
  366.  * called as close as possible to 500 ms before the new second starts.
  367.  */
  368. if ((time_status & STA_UNSYNC) == 0 &&
  369.     xtime.tv_sec > last_rtc_update + 660 &&
  370.     xtime.tv_usec >= 500000 - ((unsigned) tick) / 2 &&
  371.     xtime.tv_usec <= 500000 + ((unsigned) tick) / 2) {
  372. if (set_rtc_mmss(xtime.tv_sec) == 0)
  373. last_rtc_update = xtime.tv_sec;
  374. else
  375. last_rtc_update = xtime.tv_sec - 600; /* do it again in 60 s */
  376. }
  377.     
  378. #ifdef CONFIG_MCA
  379. if( MCA_bus ) {
  380. /* The PS/2 uses level-triggered interrupts.  You can't
  381. turn them off, nor would you want to (any attempt to
  382. enable edge-triggered interrupts usually gets intercepted by a
  383. special hardware circuit).  Hence we have to acknowledge
  384. the timer interrupt.  Through some incredibly stupid
  385. design idea, the reset for IRQ 0 is done by setting the
  386. high bit of the PPI port B (0x61).  Note that some PS/2s,
  387. notably the 55SX, work fine if this is removed.  */
  388. irq = inb_p( 0x61 ); /* read the current state */
  389. outb_p( irq|0x80, 0x61 ); /* reset the IRQ */
  390. }
  391. #endif
  392. }
  393. static int use_tsc;
  394. /*
  395.  * This is the same as the above, except we _also_ save the current
  396.  * Time Stamp Counter value at the time of the timer interrupt, so that
  397.  * we later on can estimate the time of day more exactly.
  398.  */
  399. static void timer_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  400. {
  401. int count;
  402. /*
  403.  * Here we are in the timer irq handler. We just have irqs locally
  404.  * disabled but we don't know if the timer_bh is running on the other
  405.  * CPU. We need to avoid to SMP race with it. NOTE: we don' t need
  406.  * the irq version of write_lock because as just said we have irq
  407.  * locally disabled. -arca
  408.  */
  409. write_lock(&xtime_lock);
  410. if (use_tsc)
  411. {
  412. /*
  413.  * It is important that these two operations happen almost at
  414.  * the same time. We do the RDTSC stuff first, since it's
  415.  * faster. To avoid any inconsistencies, we need interrupts
  416.  * disabled locally.
  417.  */
  418. /*
  419.  * Interrupts are just disabled locally since the timer irq
  420.  * has the SA_INTERRUPT flag set. -arca
  421.  */
  422. /* read Pentium cycle counter */
  423. rdtscl(last_tsc_low);
  424. spin_lock(&i8253_lock);
  425. outb_p(0x00, 0x43);     /* latch the count ASAP */
  426. count = inb_p(0x40);    /* read the latched count */
  427. count |= inb(0x40) << 8;
  428. spin_unlock(&i8253_lock);
  429. count = ((LATCH-1) - count) * TICK_SIZE;
  430. delay_at_last_interrupt = (count + LATCH/2) / LATCH;
  431. }
  432.  
  433. do_timer_interrupt(irq, NULL, regs);
  434. write_unlock(&xtime_lock);
  435. }
  436. /* not static: needed by APM */
  437. unsigned long get_cmos_time(void)
  438. {
  439. unsigned int year, mon, day, hour, min, sec;
  440. int i;
  441. spin_lock(&rtc_lock);
  442. /* The Linux interpretation of the CMOS clock register contents:
  443.  * When the Update-In-Progress (UIP) flag goes from 1 to 0, the
  444.  * RTC registers show the second which has precisely just started.
  445.  * Let's hope other operating systems interpret the RTC the same way.
  446.  */
  447. /* read RTC exactly on falling edge of update flag */
  448. for (i = 0 ; i < 1000000 ; i++) /* may take up to 1 second... */
  449. if (CMOS_READ(RTC_FREQ_SELECT) & RTC_UIP)
  450. break;
  451. for (i = 0 ; i < 1000000 ; i++) /* must try at least 2.228 ms */
  452. if (!(CMOS_READ(RTC_FREQ_SELECT) & RTC_UIP))
  453. break;
  454. do { /* Isn't this overkill ? UIP above should guarantee consistency */
  455. sec = CMOS_READ(RTC_SECONDS);
  456. min = CMOS_READ(RTC_MINUTES);
  457. hour = CMOS_READ(RTC_HOURS);
  458. day = CMOS_READ(RTC_DAY_OF_MONTH);
  459. mon = CMOS_READ(RTC_MONTH);
  460. year = CMOS_READ(RTC_YEAR);
  461. } while (sec != CMOS_READ(RTC_SECONDS));
  462. if (!(CMOS_READ(RTC_CONTROL) & RTC_DM_BINARY) || RTC_ALWAYS_BCD)
  463.   {
  464.     BCD_TO_BIN(sec);
  465.     BCD_TO_BIN(min);
  466.     BCD_TO_BIN(hour);
  467.     BCD_TO_BIN(day);
  468.     BCD_TO_BIN(mon);
  469.     BCD_TO_BIN(year);
  470.   }
  471. spin_unlock(&rtc_lock);
  472. if ((year += 1900) < 1970)
  473. year += 100;
  474. return mktime(year, mon, day, hour, min, sec);
  475. }
  476. static struct irqaction irq0  = { timer_interrupt, SA_INTERRUPT, 0, "timer", NULL, NULL};
  477. /* ------ Calibrate the TSC ------- 
  478.  * Return 2^32 * (1 / (TSC clocks per usec)) for do_fast_gettimeoffset().
  479.  * Too much 64-bit arithmetic here to do this cleanly in C, and for
  480.  * accuracy's sake we want to keep the overhead on the CTC speaker (channel 2)
  481.  * output busy loop as low as possible. We avoid reading the CTC registers
  482.  * directly because of the awkward 8-bit access mechanism of the 82C54
  483.  * device.
  484.  */
  485. #define CALIBRATE_LATCH (5 * LATCH)
  486. #define CALIBRATE_TIME (5 * 1000020/HZ)
  487. static unsigned long __init calibrate_tsc(void)
  488. {
  489.        /* Set the Gate high, disable speaker */
  490. outb((inb(0x61) & ~0x02) | 0x01, 0x61);
  491. /*
  492.  * Now let's take care of CTC channel 2
  493.  *
  494.  * Set the Gate high, program CTC channel 2 for mode 0,
  495.  * (interrupt on terminal count mode), binary count,
  496.  * load 5 * LATCH count, (LSB and MSB) to begin countdown.
  497.  */
  498. outb(0xb0, 0x43); /* binary, mode 0, LSB/MSB, Ch 2 */
  499. outb(CALIBRATE_LATCH & 0xff, 0x42); /* LSB of count */
  500. outb(CALIBRATE_LATCH >> 8, 0x42); /* MSB of count */
  501. {
  502. unsigned long startlow, starthigh;
  503. unsigned long endlow, endhigh;
  504. unsigned long count;
  505. rdtsc(startlow,starthigh);
  506. count = 0;
  507. do {
  508. count++;
  509. } while ((inb(0x61) & 0x20) == 0);
  510. rdtsc(endlow,endhigh);
  511. last_tsc_low = endlow;
  512. /* Error: ECTCNEVERSET */
  513. if (count <= 1)
  514. goto bad_ctc;
  515. /* 64-bit subtract - gcc just messes up with long longs */
  516. __asm__("subl %2,%0nt"
  517. "sbbl %3,%1"
  518. :"=a" (endlow), "=d" (endhigh)
  519. :"g" (startlow), "g" (starthigh),
  520.  "0" (endlow), "1" (endhigh));
  521. /* Error: ECPUTOOFAST */
  522. if (endhigh)
  523. goto bad_ctc;
  524. /* Error: ECPUTOOSLOW */
  525. if (endlow <= CALIBRATE_TIME)
  526. goto bad_ctc;
  527. __asm__("divl %2"
  528. :"=a" (endlow), "=d" (endhigh)
  529. :"r" (endlow), "0" (0), "1" (CALIBRATE_TIME));
  530. return endlow;
  531. }
  532. /*
  533.  * The CTC wasn't reliable: we got a hit on the very first read,
  534.  * or the CPU was so fast/slow that the quotient wouldn't fit in
  535.  * 32 bits..
  536.  */
  537. bad_ctc:
  538. return 0;
  539. }
  540. void __init time_init(void)
  541. {
  542. extern int x86_udelay_tsc;
  543. xtime.tv_sec = get_cmos_time();
  544. xtime.tv_usec = 0;
  545. /*
  546.  * If we have APM enabled or the CPU clock speed is variable
  547.  * (CPU stops clock on HLT or slows clock to save power)
  548.  * then the TSC timestamps may diverge by up to 1 jiffy from
  549.  * 'real time' but nothing will break.
  550.  * The most frequent case is that the CPU is "woken" from a halt
  551.  * state by the timer interrupt itself, so we get 0 error. In the
  552.  * rare cases where a driver would "wake" the CPU and request a
  553.  * timestamp, the maximum error is < 1 jiffy. But timestamps are
  554.  * still perfectly ordered.
  555.  * Note that the TSC counter will be reset if APM suspends
  556.  * to disk; this won't break the kernel, though, 'cuz we're
  557.  * smart.  See arch/i386/kernel/apm.c.
  558.  */
  559.   /*
  560.    * Firstly we have to do a CPU check for chips with
  561.    *  a potentially buggy TSC. At this point we haven't run
  562.    * the ident/bugs checks so we must run this hook as it
  563.    * may turn off the TSC flag.
  564.    *
  565.    * NOTE: this doesnt yet handle SMP 486 machines where only
  566.    * some CPU's have a TSC. Thats never worked and nobody has
  567.    * moaned if you have the only one in the world - you fix it!
  568.    */
  569.  
  570.   dodgy_tsc();
  571.  
  572. if (cpu_has_tsc) {
  573. unsigned long tsc_quotient = calibrate_tsc();
  574. if (tsc_quotient) {
  575. fast_gettimeoffset_quotient = tsc_quotient;
  576. use_tsc = 1;
  577. /*
  578.  * We could be more selective here I suspect
  579.  * and just enable this for the next intel chips ?
  580.  */
  581. x86_udelay_tsc = 1;
  582. #ifndef do_gettimeoffset
  583. do_gettimeoffset = do_fast_gettimeoffset;
  584. #endif
  585. /* report CPU clock rate in Hz.
  586.  * The formula is (10^6 * 2^32) / (2^32 * 1 / (clocks/us)) =
  587.  * clock/second. Our precision is about 100 ppm.
  588.  */
  589. { unsigned long eax=0, edx=1000;
  590. __asm__("divl %2"
  591.         :"=a" (cpu_khz), "=d" (edx)
  592.                  :"r" (tsc_quotient),
  593.                  "0" (eax), "1" (edx));
  594. printk("Detected %lu.%03lu MHz processor.n", cpu_khz / 1000, cpu_khz % 1000);
  595. }
  596. }
  597. }
  598. #ifdef CONFIG_VISWS
  599. printk("Starting Cobalt Timer system clockn");
  600. /* Set the countdown value */
  601. co_cpu_write(CO_CPU_TIMEVAL, CO_TIME_HZ/HZ);
  602. /* Start the timer */
  603. co_cpu_write(CO_CPU_CTRL, co_cpu_read(CO_CPU_CTRL) | CO_CTRL_TIMERUN);
  604. /* Enable (unmask) the timer interrupt */
  605. co_cpu_write(CO_CPU_CTRL, co_cpu_read(CO_CPU_CTRL) & ~CO_CTRL_TIMEMASK);
  606. /* Wire cpu IDT entry to s/w handler (and Cobalt APIC to IDT) */
  607. setup_irq(CO_IRQ_TIMER, &irq0);
  608. #else
  609. setup_irq(0, &irq0);
  610. #endif
  611. }