time.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:16k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/arch/alpha/kernel/time.c
  3.  *
  4.  *  Copyright (C) 1991, 1992, 1995, 1999, 2000  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.  * 1997-09-10 Updated NTP code according to technical memorandum Jan '96
  14.  * "A Kernel Model for Precision Timekeeping" by Dave Mills
  15.  * 1997-01-09    Adrian Sun
  16.  *      use interval timer if CONFIG_RTC=y
  17.  * 1997-10-29    John Bowman (bowman@math.ualberta.ca)
  18.  *      fixed tick loss calculation in timer_interrupt
  19.  *      (round system clock to nearest tick instead of truncating)
  20.  *      fixed algorithm in time_init for getting time from CMOS clock
  21.  * 1999-04-16 Thorsten Kranzkowski (dl8bcu@gmx.net)
  22.  * fixed algorithm in do_gettimeofday() for calculating the precise time
  23.  * from processor cycle counter (now taking lost_ticks into account)
  24.  * 2000-08-13 Jan-Benedict Glaw <jbglaw@lug-owl.de>
  25.  *  Fixed time_init to be aware of epoches != 1900. This prevents
  26.  *  booting up in 2048 for me;) Code is stolen from rtc.c.
  27.  */
  28. #include <linux/config.h>
  29. #include <linux/errno.h>
  30. #include <linux/sched.h>
  31. #include <linux/kernel.h>
  32. #include <linux/param.h>
  33. #include <linux/string.h>
  34. #include <linux/mm.h>
  35. #include <linux/delay.h>
  36. #include <linux/ioport.h>
  37. #include <linux/irq.h>
  38. #include <linux/interrupt.h>
  39. #include <linux/init.h>
  40. #include <asm/uaccess.h>
  41. #include <asm/io.h>
  42. #include <asm/hwrpb.h>
  43. #include <linux/mc146818rtc.h>
  44. #include <linux/timex.h>
  45. #include "proto.h"
  46. #include "irq_impl.h"
  47. extern rwlock_t xtime_lock;
  48. extern unsigned long wall_jiffies; /* kernel/timer.c */
  49. static int set_rtc_mmss(unsigned long);
  50. spinlock_t rtc_lock = SPIN_LOCK_UNLOCKED;
  51. /*
  52.  * Shift amount by which scaled_ticks_per_cycle is scaled.  Shifting
  53.  * by 48 gives us 16 bits for HZ while keeping the accuracy good even
  54.  * for large CPU clock rates.
  55.  */
  56. #define FIX_SHIFT 48
  57. /* lump static variables together for more efficient access: */
  58. static struct {
  59. /* cycle counter last time it got invoked */
  60. __u32 last_time;
  61. /* ticks/cycle * 2^48 */
  62. unsigned long scaled_ticks_per_cycle;
  63. /* last time the CMOS clock got updated */
  64. time_t last_rtc_update;
  65. /* partial unused tick */
  66. unsigned long partial_tick;
  67. } state;
  68. unsigned long est_cycle_freq;
  69. static inline __u32 rpcc(void)
  70. {
  71.     __u32 result;
  72.     asm volatile ("rpcc %0" : "=r"(result));
  73.     return result;
  74. }
  75. /*
  76.  * timer_interrupt() needs to keep up the real-time clock,
  77.  * as well as call the "do_timer()" routine every clocktick
  78.  */
  79. void timer_interrupt(int irq, void *dev, struct pt_regs * regs)
  80. {
  81. unsigned long delta;
  82. __u32 now;
  83. long nticks;
  84. #ifndef CONFIG_SMP
  85. /* Not SMP, do kernel PC profiling here.  */
  86. if (!user_mode(regs))
  87. alpha_do_profile(regs->pc);
  88. #endif
  89. write_lock(&xtime_lock);
  90. /*
  91.  * Calculate how many ticks have passed since the last update,
  92.  * including any previous partial leftover.  Save any resulting
  93.  * fraction for the next pass.
  94.  */
  95. now = rpcc();
  96. delta = now - state.last_time;
  97. state.last_time = now;
  98. delta = delta * state.scaled_ticks_per_cycle + state.partial_tick;
  99. state.partial_tick = delta & ((1UL << FIX_SHIFT) - 1); 
  100. nticks = delta >> FIX_SHIFT;
  101. while (nticks > 0) {
  102. do_timer(regs);
  103. nticks--;
  104. }
  105. /*
  106.  * If we have an externally synchronized Linux clock, then update
  107.  * CMOS clock accordingly every ~11 minutes. Set_rtc_mmss() has to be
  108.  * called as close as possible to 500 ms before the new second starts.
  109.  */
  110. if ((time_status & STA_UNSYNC) == 0
  111.     && xtime.tv_sec > state.last_rtc_update + 660
  112.     && xtime.tv_usec >= 500000 - ((unsigned) tick) / 2
  113.     && xtime.tv_usec <= 500000 + ((unsigned) tick) / 2) {
  114. int tmp = set_rtc_mmss(xtime.tv_sec);
  115. state.last_rtc_update = xtime.tv_sec - (tmp ? 600 : 0);
  116. }
  117. write_unlock(&xtime_lock);
  118. }
  119. void
  120. common_init_rtc(void)
  121. {
  122. unsigned char x;
  123. /* Reset periodic interrupt frequency.  */
  124. x = CMOS_READ(RTC_FREQ_SELECT) & 0x3f;
  125. if (x != 0x26 && x != 0x19 && x != 0x06) {
  126. printk("Setting RTC_FREQ to 1024 Hz (%x)n", x);
  127. CMOS_WRITE(0x26, RTC_FREQ_SELECT);
  128. }
  129. /* Turn on periodic interrupts.  */
  130. x = CMOS_READ(RTC_CONTROL);
  131. if (!(x & RTC_PIE)) {
  132. printk("Turning on RTC interrupts.n");
  133. x |= RTC_PIE;
  134. x &= ~(RTC_AIE | RTC_UIE);
  135. CMOS_WRITE(x, RTC_CONTROL);
  136. }
  137. (void) CMOS_READ(RTC_INTR_FLAGS);
  138. outb(0x36, 0x43); /* pit counter 0: system timer */
  139. outb(0x00, 0x40);
  140. outb(0x00, 0x40);
  141. outb(0xb6, 0x43); /* pit counter 2: speaker */
  142. outb(0x31, 0x42);
  143. outb(0x13, 0x42);
  144. init_rtc_irq();
  145. }
  146. /* Validate a computed cycle counter result against the known bounds for
  147.    the given processor core.  There's too much brokenness in the way of
  148.    timing hardware for any one method to work everywhere.  :-(
  149.    Return 0 if the result cannot be trusted, otherwise return the argument.  */
  150. static unsigned long __init
  151. validate_cc_value(unsigned long cc)
  152. {
  153. static struct bounds {
  154. unsigned int min, max;
  155. } cpu_hz[] __initdata = {
  156. [EV3_CPU]    = {   50000000,  200000000 }, /* guess */
  157. [EV4_CPU]    = {  150000000,  300000000 },
  158. [LCA4_CPU]   = {  150000000,  300000000 }, /* guess */
  159. [EV45_CPU]   = {  200000000,  300000000 },
  160. [EV5_CPU]    = {  250000000,  433000000 },
  161. [EV56_CPU]   = {  333000000,  667000000 },
  162. [PCA56_CPU]  = {  400000000,  600000000 }, /* guess */
  163. [PCA57_CPU]  = {  500000000,  600000000 }, /* guess */
  164. [EV6_CPU]    = {  466000000,  600000000 },
  165. [EV67_CPU]   = {  600000000,  750000000 },
  166. [EV68AL_CPU] = {  750000000,  940000000 },
  167. [EV68CB_CPU] = { 1000000000, 1333333333 },
  168. /* None of the following are shipping as of 2001-11-01.  */
  169. [EV68CX_CPU] = { 1000000000, 1700000000 }, /* guess */
  170. [EV69_CPU]   = { 1000000000, 1700000000 }, /* guess */
  171. [EV7_CPU]    = {  800000000, 1400000000 }, /* guess */
  172. [EV79_CPU]   = { 1000000000, 2000000000 }, /* guess */
  173. };
  174. /* Allow for some drift in the crystal.  10MHz is more than enough.  */
  175. const unsigned int deviation = 10000000;
  176. struct percpu_struct *cpu;
  177. unsigned int index;
  178. cpu = (struct percpu_struct *)((char*)hwrpb + hwrpb->processor_offset);
  179. index = cpu->type & 0xffffffff;
  180. /* If index out of bounds, no way to validate.  */
  181. if (index >= sizeof(cpu_hz)/sizeof(cpu_hz[0]))
  182. return cc;
  183. /* If index contains no data, no way to validate.  */
  184. if (cpu_hz[index].max == 0)
  185. return cc;
  186. if (cc < cpu_hz[index].min - deviation
  187.     || cc > cpu_hz[index].max + deviation)
  188. return 0;
  189. return cc;
  190. }
  191. /*
  192.  * Calibrate CPU clock using legacy 8254 timer/counter. Stolen from
  193.  * arch/i386/time.c.
  194.  */
  195. #define CALIBRATE_LATCH (52 * LATCH)
  196. #define CALIBRATE_TIME (52 * 1000020 / HZ)
  197. static unsigned long __init
  198. calibrate_cc_with_pic(void)
  199. {
  200. int cc, count = 0;
  201. /* Set the Gate high, disable speaker */
  202. outb((inb(0x61) & ~0x02) | 0x01, 0x61);
  203. /*
  204.  * Now let's take care of CTC channel 2
  205.  *
  206.  * Set the Gate high, program CTC channel 2 for mode 0,
  207.  * (interrupt on terminal count mode), binary count,
  208.  * load 5 * LATCH count, (LSB and MSB) to begin countdown.
  209.  */
  210. outb(0xb0, 0x43); /* binary, mode 0, LSB/MSB, Ch 2 */
  211. outb(CALIBRATE_LATCH & 0xff, 0x42); /* LSB of count */
  212. outb(CALIBRATE_LATCH >> 8, 0x42); /* MSB of count */
  213. cc = rpcc();
  214. do {
  215. count++;
  216. } while ((inb(0x61) & 0x20) == 0 && count > 0);
  217. cc = rpcc() - cc;
  218. /* Error: ECTCNEVERSET or ECPUTOOFAST.  */
  219. if (count <= 1)
  220. return 0;
  221. /* Error: ECPUTOOSLOW.  */
  222. if (cc <= CALIBRATE_TIME)
  223. return 0;
  224. return (cc * 1000000UL) / CALIBRATE_TIME;
  225. }
  226. /* The Linux interpretation of the CMOS clock register contents:
  227.    When the Update-In-Progress (UIP) flag goes from 1 to 0, the
  228.    RTC registers show the second which has precisely just started.
  229.    Let's hope other operating systems interpret the RTC the same way.  */
  230. static unsigned long __init
  231. rpcc_after_update_in_progress(void)
  232. {
  233. do { } while (!(CMOS_READ(RTC_FREQ_SELECT) & RTC_UIP));
  234. do { } while (CMOS_READ(RTC_FREQ_SELECT) & RTC_UIP);
  235. return rpcc();
  236. }
  237. void __init
  238. time_init(void)
  239. {
  240. unsigned int year, mon, day, hour, min, sec, cc1, cc2, epoch;
  241. unsigned long cycle_freq, one_percent;
  242. long diff;
  243. /* Calibrate CPU clock -- attempt #1.  */
  244. if (!est_cycle_freq)
  245. est_cycle_freq = validate_cc_value(calibrate_cc_with_pic());
  246. cc1 = rpcc_after_update_in_progress();
  247. /* Calibrate CPU clock -- attempt #2.  */
  248. if (!est_cycle_freq) {
  249. cc2 = rpcc_after_update_in_progress();
  250. est_cycle_freq = validate_cc_value(cc2 - cc1);
  251. cc1 = cc2;
  252. }
  253. cycle_freq = hwrpb->cycle_freq;
  254. if (est_cycle_freq) {
  255. /* If the given value is within 1% of what we calculated, 
  256.    accept it.  Otherwise, use what we found.  */
  257. one_percent = cycle_freq / 100;
  258. diff = cycle_freq - est_cycle_freq;
  259. if (diff < 0)
  260. diff = -diff;
  261. if (diff > one_percent) {
  262. cycle_freq = est_cycle_freq;
  263. printk("HWRPB cycle frequency bogus.  "
  264.        "Estimated %lu Hzn", cycle_freq);
  265. } else {
  266. est_cycle_freq = 0;
  267. }
  268. } else if (! validate_cc_value (cycle_freq)) {
  269. printk("HWRPB cycle frequency bogus, "
  270.        "and unable to estimate a proper value!n");
  271. }
  272. /* From John Bowman <bowman@math.ualberta.ca>: allow the values
  273.    to settle, as the Update-In-Progress bit going low isn't good
  274.    enough on some hardware.  2ms is our guess; we havn't found 
  275.    bogomips yet, but this is close on a 500Mhz box.  */
  276. __delay(1000000);
  277. sec = CMOS_READ(RTC_SECONDS);
  278. min = CMOS_READ(RTC_MINUTES);
  279. hour = CMOS_READ(RTC_HOURS);
  280. day = CMOS_READ(RTC_DAY_OF_MONTH);
  281. mon = CMOS_READ(RTC_MONTH);
  282. year = CMOS_READ(RTC_YEAR);
  283. if (!(CMOS_READ(RTC_CONTROL) & RTC_DM_BINARY) || RTC_ALWAYS_BCD) {
  284. BCD_TO_BIN(sec);
  285. BCD_TO_BIN(min);
  286. BCD_TO_BIN(hour);
  287. BCD_TO_BIN(day);
  288. BCD_TO_BIN(mon);
  289. BCD_TO_BIN(year);
  290. }
  291. /* PC-like is standard; used for year < 20 || year >= 70 */
  292. epoch = 1900;
  293. if (year < 20)
  294. epoch = 2000;
  295. else if (year >= 20 && year < 48)
  296. /* NT epoch */
  297. epoch = 1980;
  298. else if (year >= 48 && year < 70)
  299. /* Digital UNIX epoch */
  300. epoch = 1952;
  301. printk(KERN_INFO "Using epoch = %dn", epoch);
  302. if ((year += epoch) < 1970)
  303. year += 100;
  304. xtime.tv_sec = mktime(year, mon, day, hour, min, sec);
  305. xtime.tv_usec = 0;
  306. if (HZ > (1<<16)) {
  307. extern void __you_loose (void);
  308. __you_loose();
  309. }
  310. state.last_time = cc1;
  311. state.scaled_ticks_per_cycle
  312. = ((unsigned long) HZ << FIX_SHIFT) / cycle_freq;
  313. state.last_rtc_update = 0;
  314. state.partial_tick = 0L;
  315. /* Startup the timer source. */
  316. alpha_mv.init_rtc();
  317. /*
  318.  * If we had wanted SRM console printk echoing early, undo it now.
  319.  *
  320.  * "srmcons" specified in the boot command arguments allows us to
  321.  * see kernel messages during the period of time before the true
  322.  * console device is "registered" during console_init(). As of this
  323.  * version (2.4.10), time_init() is the last Alpha-specific code
  324.  * called before console_init(), so we put this "unregister" code
  325.  * here to prevent schizophrenic console behavior later... ;-}
  326.  */
  327. if (alpha_using_srm && srmcons_output) {
  328. unregister_srm_console();
  329. srmcons_output = 0;
  330. }
  331. }
  332. /*
  333.  * Use the cycle counter to estimate an displacement from the last time
  334.  * tick.  Unfortunately the Alpha designers made only the low 32-bits of
  335.  * the cycle counter active, so we overflow on 8.2 seconds on a 500MHz
  336.  * part.  So we can't do the "find absolute time in terms of cycles" thing
  337.  * that the other ports do.
  338.  */
  339. void
  340. do_gettimeofday(struct timeval *tv)
  341. {
  342. unsigned long sec, usec, lost, flags;
  343. unsigned long delta_cycles, delta_usec, partial_tick;
  344. read_lock_irqsave(&xtime_lock, flags);
  345. delta_cycles = rpcc() - state.last_time;
  346. sec = xtime.tv_sec;
  347. usec = xtime.tv_usec;
  348. partial_tick = state.partial_tick;
  349. lost = jiffies - wall_jiffies;
  350. read_unlock_irqrestore(&xtime_lock, flags);
  351. #ifdef CONFIG_SMP
  352. /* Until and unless we figure out how to get cpu cycle counters
  353.    in sync and keep them there, we can't use the rpcc tricks.  */
  354. delta_usec = lost * (1000000 / HZ);
  355. #else
  356. /*
  357.  * usec = cycles * ticks_per_cycle * 2**48 * 1e6 / (2**48 * ticks)
  358.  * = cycles * (s_t_p_c) * 1e6 / (2**48 * ticks)
  359.  * = cycles * (s_t_p_c) * 15625 / (2**42 * ticks)
  360.  *
  361.  * which, given a 600MHz cycle and a 1024Hz tick, has a
  362.  * dynamic range of about 1.7e17, which is less than the
  363.  * 1.8e19 in an unsigned long, so we are safe from overflow.
  364.  *
  365.  * Round, but with .5 up always, since .5 to even is harder
  366.  * with no clear gain.
  367.  */
  368. delta_usec = (delta_cycles * state.scaled_ticks_per_cycle 
  369.       + partial_tick
  370.       + (lost << FIX_SHIFT)) * 15625;
  371. delta_usec = ((delta_usec / ((1UL << (FIX_SHIFT-6-1)) * HZ)) + 1) / 2;
  372. #endif
  373. usec += delta_usec;
  374. if (usec >= 1000000) {
  375. sec += 1;
  376. usec -= 1000000;
  377. }
  378. tv->tv_sec = sec;
  379. tv->tv_usec = usec;
  380. }
  381. void
  382. do_settimeofday(struct timeval *tv)
  383. {
  384. unsigned long delta_usec;
  385. long sec, usec;
  386. write_lock_irq(&xtime_lock);
  387. /* The offset that is added into time in do_gettimeofday above
  388.    must be subtracted out here to keep a coherent view of the
  389.    time.  Without this, a full-tick error is possible.  */
  390. #ifdef CONFIG_SMP
  391. delta_usec = (jiffies - wall_jiffies) * (1000000 / HZ);
  392. #else
  393. delta_usec = rpcc() - state.last_time;
  394. delta_usec = (delta_usec * state.scaled_ticks_per_cycle 
  395.       + state.partial_tick
  396.       + ((jiffies - wall_jiffies) << FIX_SHIFT)) * 15625;
  397. delta_usec = ((delta_usec / ((1UL << (FIX_SHIFT-6-1)) * HZ)) + 1) / 2;
  398. #endif
  399. sec = tv->tv_sec;
  400. usec = tv->tv_usec;
  401. usec -= delta_usec;
  402. if (usec < 0) {
  403. usec += 1000000;
  404. sec -= 1;
  405. }
  406. xtime.tv_sec = sec;
  407. xtime.tv_usec = usec;
  408. time_adjust = 0; /* stop active adjtime() */
  409. time_status |= STA_UNSYNC;
  410. time_maxerror = NTP_PHASE_LIMIT;
  411. time_esterror = NTP_PHASE_LIMIT;
  412. write_unlock_irq(&xtime_lock);
  413. }
  414. /*
  415.  * In order to set the CMOS clock precisely, set_rtc_mmss has to be
  416.  * called 500 ms after the second nowtime has started, because when
  417.  * nowtime is written into the registers of the CMOS clock, it will
  418.  * jump to the next second precisely 500 ms later. Check the Motorola
  419.  * MC146818A or Dallas DS12887 data sheet for details.
  420.  *
  421.  * BUG: This routine does not handle hour overflow properly; it just
  422.  *      sets the minutes. Usually you won't notice until after reboot!
  423.  */
  424. extern int abs(int);
  425. static int
  426. set_rtc_mmss(unsigned long nowtime)
  427. {
  428. int retval = 0;
  429. int real_seconds, real_minutes, cmos_minutes;
  430. unsigned char save_control, save_freq_select;
  431. /* irq are locally disabled here */
  432. spin_lock(&rtc_lock);
  433. /* Tell the clock it's being set */
  434. save_control = CMOS_READ(RTC_CONTROL);
  435. CMOS_WRITE((save_control|RTC_SET), RTC_CONTROL);
  436. /* Stop and reset prescaler */
  437. save_freq_select = CMOS_READ(RTC_FREQ_SELECT);
  438. CMOS_WRITE((save_freq_select|RTC_DIV_RESET2), RTC_FREQ_SELECT);
  439. cmos_minutes = CMOS_READ(RTC_MINUTES);
  440. if (!(save_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD)
  441. BCD_TO_BIN(cmos_minutes);
  442. /*
  443.  * since we're only adjusting minutes and seconds,
  444.  * don't interfere with hour overflow. This avoids
  445.  * messing with unknown time zones but requires your
  446.  * RTC not to be off by more than 15 minutes
  447.  */
  448. real_seconds = nowtime % 60;
  449. real_minutes = nowtime / 60;
  450. if (((abs(real_minutes - cmos_minutes) + 15)/30) & 1) {
  451. /* correct for half hour time zone */
  452. real_minutes += 30;
  453. }
  454. real_minutes %= 60;
  455. if (abs(real_minutes - cmos_minutes) < 30) {
  456. if (!(save_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD) {
  457. BIN_TO_BCD(real_seconds);
  458. BIN_TO_BCD(real_minutes);
  459. }
  460. CMOS_WRITE(real_seconds,RTC_SECONDS);
  461. CMOS_WRITE(real_minutes,RTC_MINUTES);
  462. } else {
  463. printk(KERN_WARNING
  464.        "set_rtc_mmss: can't update from %d to %dn",
  465.        cmos_minutes, real_minutes);
  466.   retval = -1;
  467. }
  468. /* The following flags have to be released exactly in this order,
  469.  * otherwise the DS12887 (popular MC146818A clone with integrated
  470.  * battery and quartz) will not reset the oscillator and will not
  471.  * update precisely 500 ms later. You won't find this mentioned in
  472.  * the Dallas Semiconductor data sheets, but who believes data
  473.  * sheets anyway ...                           -- Markus Kuhn
  474.  */
  475. CMOS_WRITE(save_control, RTC_CONTROL);
  476. CMOS_WRITE(save_freq_select, RTC_FREQ_SELECT);
  477. spin_unlock(&rtc_lock);
  478. return retval;
  479. }