git.oblomov.eu Git - linux-2.6/blob - arch/x86_64/kernel/time.c

   1 /*
   2  *  linux/arch/x86-64/kernel/time.c
   3  *
   4  *  "High Precision Event Timer" based timekeeping.
   5  *
   6  *  Copyright (c) 1991,1992,1995  Linus Torvalds
   7  *  Copyright (c) 1994  Alan Modra
   8  *  Copyright (c) 1995  Markus Kuhn
   9  *  Copyright (c) 1996  Ingo Molnar
  10  *  Copyright (c) 1998  Andrea Arcangeli
  11  *  Copyright (c) 2002,2006  Vojtech Pavlik
  12  *  Copyright (c) 2003  Andi Kleen
  13  *  RTC support code taken from arch/i386/kernel/timers/time_hpet.c
  14  */
  15
  16 #include <linux/kernel.h>
  17 #include <linux/sched.h>
  18 #include <linux/interrupt.h>
  19 #include <linux/init.h>
  20 #include <linux/mc146818rtc.h>
  21 #include <linux/time.h>
  22 #include <linux/ioport.h>
  23 #include <linux/module.h>
  24 #include <linux/device.h>
  25 #include <linux/sysdev.h>
  26 #include <linux/bcd.h>
  27 #include <linux/notifier.h>
  28 #include <linux/cpu.h>
  29 #include <linux/kallsyms.h>
  30 #include <linux/acpi.h>
  31 #ifdef CONFIG_ACPI
  32 #include <acpi/achware.h>       /* for PM timer frequency */
  33 #include <acpi/acpi_bus.h>
  34 #endif
  35 #include <asm/8253pit.h>
  36 #include <asm/pgtable.h>
  37 #include <asm/vsyscall.h>
  38 #include <asm/timex.h>
  39 #include <asm/proto.h>
  40 #include <asm/hpet.h>
  41 #include <asm/sections.h>
  42 #include <linux/cpufreq.h>
  43 #include <linux/hpet.h>
  44 #include <asm/apic.h>
  45
  46 #ifdef CONFIG_CPU_FREQ
  47 static void cpufreq_delayed_get(void);
  48 #endif
  49 extern void i8254_timer_resume(void);
  50 extern int using_apic_timer;
  51
  52 static char *timename = NULL;
  53
  54 DEFINE_SPINLOCK(rtc_lock);
  55 EXPORT_SYMBOL(rtc_lock);
  56 DEFINE_SPINLOCK(i8253_lock);
  57
  58 int nohpet __initdata = 0;
  59 static int notsc __initdata = 0;
  60
  61 #define USEC_PER_TICK (USEC_PER_SEC / HZ)
  62 #define NSEC_PER_TICK (NSEC_PER_SEC / HZ)
  63 #define FSEC_PER_TICK (FSEC_PER_SEC / HZ)
  64
  65 #define NS_SCALE        10 /* 2^10, carefully chosen */
  66 #define US_SCALE        32 /* 2^32, arbitralrily chosen */
  67
  68 unsigned int cpu_khz;                                   /* TSC clocks / usec, not used here */
  69 EXPORT_SYMBOL(cpu_khz);
  70 static unsigned long hpet_period;                       /* fsecs / HPET clock */
  71 unsigned long hpet_tick;                                /* HPET clocks / interrupt */
  72 int hpet_use_timer;                             /* Use counter of hpet for time keeping, otherwise PIT */
  73 unsigned long vxtime_hz = PIT_TICK_RATE;
  74 int report_lost_ticks;                          /* command line option */
  75 unsigned long long monotonic_base;
  76
  77 struct vxtime_data __vxtime __section_vxtime;   /* for vsyscalls */
  78
  79 volatile unsigned long __jiffies __section_jiffies = INITIAL_JIFFIES;
  80 struct timespec __xtime __section_xtime;
  81 struct timezone __sys_tz __section_sys_tz;
  82
  83 /*
  84  * do_gettimeoffset() returns microseconds since last timer interrupt was
  85  * triggered by hardware. A memory read of HPET is slower than a register read
  86  * of TSC, but much more reliable. It's also synchronized to the timer
  87  * interrupt. Note that do_gettimeoffset() may return more than hpet_tick, if a
  88  * timer interrupt has happened already, but vxtime.trigger wasn't updated yet.
  89  * This is not a problem, because jiffies hasn't updated either. They are bound
  90  * together by xtime_lock.
  91  */
  92
  93 static inline unsigned int do_gettimeoffset_tsc(void)
  94 {
  95         unsigned long t;
  96         unsigned long x;
  97         t = get_cycles_sync();
  98         if (t < vxtime.last_tsc)
  99                 t = vxtime.last_tsc; /* hack */
 100         x = ((t - vxtime.last_tsc) * vxtime.tsc_quot) >> US_SCALE;
 101         return x;
 102 }
 103
 104 static inline unsigned int do_gettimeoffset_hpet(void)
 105 {
 106         /* cap counter read to one tick to avoid inconsistencies */
 107         unsigned long counter = hpet_readl(HPET_COUNTER) - vxtime.last;
 108         return (min(counter,hpet_tick) * vxtime.quot) >> US_SCALE;
 109 }
 110
 111 unsigned int (*do_gettimeoffset)(void) = do_gettimeoffset_tsc;
 112
 113 /*
 114  * This version of gettimeofday() has microsecond resolution and better than
 115  * microsecond precision, as we're using at least a 10 MHz (usually 14.31818
 116  * MHz) HPET timer.
 117  */
 118
 119 void do_gettimeofday(struct timeval *tv)
 120 {
 121         unsigned long seq;
 122         unsigned int sec, usec;
 123
 124         do {
 125                 seq = read_seqbegin(&xtime_lock);
 126
 127                 sec = xtime.tv_sec;
 128                 usec = xtime.tv_nsec / NSEC_PER_USEC;
 129
 130                 /* i386 does some correction here to keep the clock
 131                    monotonous even when ntpd is fixing drift.
 132                    But they didn't work for me, there is a non monotonic
 133                    clock anyways with ntp.
 134                    I dropped all corrections now until a real solution can
 135                    be found. Note when you fix it here you need to do the same
 136                    in arch/x86_64/kernel/vsyscall.c and export all needed
 137                    variables in vmlinux.lds. -AK */
 138                 usec += do_gettimeoffset();
 139
 140         } while (read_seqretry(&xtime_lock, seq));
 141
 142         tv->tv_sec = sec + usec / USEC_PER_SEC;
 143         tv->tv_usec = usec % USEC_PER_SEC;
 144 }
 145
 146 EXPORT_SYMBOL(do_gettimeofday);
 147
 148 /*
 149  * settimeofday() first undoes the correction that gettimeofday would do
 150  * on the time, and then saves it. This is ugly, but has been like this for
 151  * ages already.
 152  */
 153
 154 int do_settimeofday(struct timespec *tv)
 155 {
 156         time_t wtm_sec, sec = tv->tv_sec;
 157         long wtm_nsec, nsec = tv->tv_nsec;
 158
 159         if ((unsigned long)tv->tv_nsec >= NSEC_PER_SEC)
 160                 return -EINVAL;
 161
 162         write_seqlock_irq(&xtime_lock);
 163
 164         nsec -= do_gettimeoffset() * NSEC_PER_USEC;
 165
 166         wtm_sec  = wall_to_monotonic.tv_sec + (xtime.tv_sec - sec);
 167         wtm_nsec = wall_to_monotonic.tv_nsec + (xtime.tv_nsec - nsec);
 168
 169         set_normalized_timespec(&xtime, sec, nsec);
 170         set_normalized_timespec(&wall_to_monotonic, wtm_sec, wtm_nsec);
 171
 172         ntp_clear();
 173
 174         write_sequnlock_irq(&xtime_lock);
 175         clock_was_set();
 176         return 0;
 177 }
 178
 179 EXPORT_SYMBOL(do_settimeofday);
 180
 181 unsigned long profile_pc(struct pt_regs *regs)
 182 {
 183         unsigned long pc = instruction_pointer(regs);
 184
 185         /* Assume the lock function has either no stack frame or a copy
 186            of eflags from PUSHF
 187            Eflags always has bits 22 and up cleared unlike kernel addresses. */
 188         if (!user_mode(regs) && in_lock_functions(pc)) {
 189                 unsigned long *sp = (unsigned long *)regs->rsp;
 190                 if (sp[0] >> 22)
 191                         return sp[0];
 192                 if (sp[1] >> 22)
 193                         return sp[1];
 194         }
 195         return pc;
 196 }
 197 EXPORT_SYMBOL(profile_pc);
 198
 199 /*
 200  * In order to set the CMOS clock precisely, set_rtc_mmss has to be called 500
 201  * ms after the second nowtime has started, because when nowtime is written
 202  * into the registers of the CMOS clock, it will jump to the next second
 203  * precisely 500 ms later. Check the Motorola MC146818A or Dallas DS12887 data
 204  * sheet for details.
 205  */
 206
 207 static void set_rtc_mmss(unsigned long nowtime)
 208 {
 209         int real_seconds, real_minutes, cmos_minutes;
 210         unsigned char control, freq_select;
 211
 212 /*
 213  * IRQs are disabled when we're called from the timer interrupt,
 214  * no need for spin_lock_irqsave()
 215  */
 216
 217         spin_lock(&rtc_lock);
 218
 219 /*
 220  * Tell the clock it's being set and stop it.
 221  */
 222
 223         control = CMOS_READ(RTC_CONTROL);
 224         CMOS_WRITE(control | RTC_SET, RTC_CONTROL);
 225
 226         freq_select = CMOS_READ(RTC_FREQ_SELECT);
 227         CMOS_WRITE(freq_select | RTC_DIV_RESET2, RTC_FREQ_SELECT);
 228
 229         cmos_minutes = CMOS_READ(RTC_MINUTES);
 230                 BCD_TO_BIN(cmos_minutes);
 231
 232 /*
 233  * since we're only adjusting minutes and seconds, don't interfere with hour
 234  * overflow. This avoids messing with unknown time zones but requires your RTC
 235  * not to be off by more than 15 minutes. Since we're calling it only when
 236  * our clock is externally synchronized using NTP, this shouldn't be a problem.
 237  */
 238
 239         real_seconds = nowtime % 60;
 240         real_minutes = nowtime / 60;
 241         if (((abs(real_minutes - cmos_minutes) + 15) / 30) & 1)
 242                 real_minutes += 30;             /* correct for half hour time zone */
 243         real_minutes %= 60;
 244
 245         if (abs(real_minutes - cmos_minutes) >= 30) {
 246                 printk(KERN_WARNING "time.c: can't update CMOS clock "
 247                        "from %d to %d\n", cmos_minutes, real_minutes);
 248         } else {
 249                 BIN_TO_BCD(real_seconds);
 250                 BIN_TO_BCD(real_minutes);
 251                 CMOS_WRITE(real_seconds, RTC_SECONDS);
 252                 CMOS_WRITE(real_minutes, RTC_MINUTES);
 253         }
 254
 255 /*
 256  * The following flags have to be released exactly in this order, otherwise the
 257  * DS12887 (popular MC146818A clone with integrated battery and quartz) will
 258  * not reset the oscillator and will not update precisely 500 ms later. You
 259  * won't find this mentioned in the Dallas Semiconductor data sheets, but who
 260  * believes data sheets anyway ... -- Markus Kuhn
 261  */
 262
 263         CMOS_WRITE(control, RTC_CONTROL);
 264         CMOS_WRITE(freq_select, RTC_FREQ_SELECT);
 265
 266         spin_unlock(&rtc_lock);
 267 }
 268
 269
 270 /* monotonic_clock(): returns # of nanoseconds passed since time_init()
 271  *              Note: This function is required to return accurate
 272  *              time even in the absence of multiple timer ticks.
 273  */
 274 static inline unsigned long long cycles_2_ns(unsigned long long cyc);
 275 unsigned long long monotonic_clock(void)
 276 {
 277         unsigned long seq;
 278         u32 last_offset, this_offset, offset;
 279         unsigned long long base;
 280
 281         if (vxtime.mode == VXTIME_HPET) {
 282                 do {
 283                         seq = read_seqbegin(&xtime_lock);
 284
 285                         last_offset = vxtime.last;
 286                         base = monotonic_base;
 287                         this_offset = hpet_readl(HPET_COUNTER);
 288                 } while (read_seqretry(&xtime_lock, seq));
 289                 offset = (this_offset - last_offset);
 290                 offset *= NSEC_PER_TICK / hpet_tick;
 291         } else {
 292                 do {
 293                         seq = read_seqbegin(&xtime_lock);
 294
 295                         last_offset = vxtime.last_tsc;
 296                         base = monotonic_base;
 297                 } while (read_seqretry(&xtime_lock, seq));
 298                 this_offset = get_cycles_sync();
 299                 offset = cycles_2_ns(this_offset - last_offset);
 300         }
 301         return base + offset;
 302 }
 303 EXPORT_SYMBOL(monotonic_clock);
 304
 305 static noinline void handle_lost_ticks(int lost)
 306 {
 307         static long lost_count;
 308         static int warned;
 309         if (report_lost_ticks) {
 310                 printk(KERN_WARNING "time.c: Lost %d timer tick(s)! ", lost);
 311                 print_symbol("rip %s)\n", get_irq_regs()->rip);
 312         }
 313
 314         if (lost_count == 1000 && !warned) {
 315                 printk(KERN_WARNING "warning: many lost ticks.\n"
 316                        KERN_WARNING "Your time source seems to be instable or "
 317                                 "some driver is hogging interupts\n");
 318                 print_symbol("rip %s\n", get_irq_regs()->rip);
 319                 if (vxtime.mode == VXTIME_TSC && vxtime.hpet_address) {
 320                         printk(KERN_WARNING "Falling back to HPET\n");
 321                         if (hpet_use_timer)
 322                                 vxtime.last = hpet_readl(HPET_T0_CMP) -
 323                                                         hpet_tick;
 324                         else
 325                                 vxtime.last = hpet_readl(HPET_COUNTER);
 326                         vxtime.mode = VXTIME_HPET;
 327                         do_gettimeoffset = do_gettimeoffset_hpet;
 328                 }
 329                 /* else should fall back to PIT, but code missing. */
 330                 warned = 1;
 331         } else
 332                 lost_count++;
 333
 334 #ifdef CONFIG_CPU_FREQ
 335         /* In some cases the CPU can change frequency without us noticing
 336            Give cpufreq a change to catch up. */
 337         if ((lost_count+1) % 25 == 0)
 338                 cpufreq_delayed_get();
 339 #endif
 340 }
 341
 342 void main_timer_handler(void)
 343 {
 344         static unsigned long rtc_update = 0;
 345         unsigned long tsc;
 346         int delay = 0, offset = 0, lost = 0;
 347
 348 /*
 349  * Here we are in the timer irq handler. We have irqs locally disabled (so we
 350  * don't need spin_lock_irqsave()) but we don't know if the timer_bh is running
 351  * on the other CPU, so we need a lock. We also need to lock the vsyscall
 352  * variables, because both do_timer() and us change them -arca+vojtech
 353  */
 354
 355         write_seqlock(&xtime_lock);
 356
 357         if (vxtime.hpet_address)
 358                 offset = hpet_readl(HPET_COUNTER);
 359
 360         if (hpet_use_timer) {
 361                 /* if we're using the hpet timer functionality,
 362                  * we can more accurately know the counter value
 363                  * when the timer interrupt occured.
 364                  */
 365                 offset = hpet_readl(HPET_T0_CMP) - hpet_tick;
 366                 delay = hpet_readl(HPET_COUNTER) - offset;
 367         } else if (!pmtmr_ioport) {
 368                 spin_lock(&i8253_lock);
 369                 outb_p(0x00, 0x43);
 370                 delay = inb_p(0x40);
 371                 delay |= inb(0x40) << 8;
 372                 spin_unlock(&i8253_lock);
 373                 delay = LATCH - 1 - delay;
 374         }
 375
 376         tsc = get_cycles_sync();
 377
 378         if (vxtime.mode == VXTIME_HPET) {
 379                 if (offset - vxtime.last > hpet_tick) {
 380                         lost = (offset - vxtime.last) / hpet_tick - 1;
 381                 }
 382
 383                 monotonic_base +=
 384                         (offset - vxtime.last) * NSEC_PER_TICK / hpet_tick;
 385
 386                 vxtime.last = offset;
 387 #ifdef CONFIG_X86_PM_TIMER
 388         } else if (vxtime.mode == VXTIME_PMTMR) {
 389                 lost = pmtimer_mark_offset();
 390 #endif
 391         } else {
 392                 offset = (((tsc - vxtime.last_tsc) *
 393                            vxtime.tsc_quot) >> US_SCALE) - USEC_PER_TICK;
 394
 395                 if (offset < 0)
 396                         offset = 0;
 397
 398                 if (offset > USEC_PER_TICK) {
 399                         lost = offset / USEC_PER_TICK;
 400                         offset %= USEC_PER_TICK;
 401                 }
 402
 403                 monotonic_base += cycles_2_ns(tsc - vxtime.last_tsc);
 404
 405                 vxtime.last_tsc = tsc - vxtime.quot * delay / vxtime.tsc_quot;
 406
 407                 if ((((tsc - vxtime.last_tsc) *
 408                       vxtime.tsc_quot) >> US_SCALE) < offset)
 409                         vxtime.last_tsc = tsc -
 410                                 (((long) offset << US_SCALE) / vxtime.tsc_quot) - 1;
 411         }
 412
 413         if (lost > 0)
 414                 handle_lost_ticks(lost);
 415         else
 416                 lost = 0;
 417
 418 /*
 419  * Do the timer stuff.
 420  */
 421
 422         do_timer(lost + 1);
 423 #ifndef CONFIG_SMP
 424         update_process_times(user_mode(get_irq_regs()));
 425 #endif
 426
 427 /*
 428  * In the SMP case we use the local APIC timer interrupt to do the profiling,
 429  * except when we simulate SMP mode on a uniprocessor system, in that case we
 430  * have to call the local interrupt handler.
 431  */
 432
 433         if (!using_apic_timer)
 434                 smp_local_timer_interrupt();
 435
 436 /*
 437  * If we have an externally synchronized Linux clock, then update CMOS clock
 438  * accordingly every ~11 minutes. set_rtc_mmss() will be called in the jiffy
 439  * closest to exactly 500 ms before the next second. If the update fails, we
 440  * don't care, as it'll be updated on the next turn, and the problem (time way
 441  * off) isn't likely to go away much sooner anyway.
 442  */
 443
 444         if (ntp_synced() && xtime.tv_sec > rtc_update &&
 445                 abs(xtime.tv_nsec - 500000000) <= tick_nsec / 2) {
 446                 set_rtc_mmss(xtime.tv_sec);
 447                 rtc_update = xtime.tv_sec + 660;
 448         }
 449
 450         write_sequnlock(&xtime_lock);
 451 }
 452
 453 static irqreturn_t timer_interrupt(int irq, void *dev_id)
 454 {
 455         if (apic_runs_main_timer > 1)
 456                 return IRQ_HANDLED;
 457         main_timer_handler();
 458         if (using_apic_timer)
 459                 smp_send_timer_broadcast_ipi();
 460         return IRQ_HANDLED;
 461 }
 462
 463 static unsigned int cyc2ns_scale __read_mostly;
 464
 465 static inline void set_cyc2ns_scale(unsigned long cpu_khz)
 466 {
 467         cyc2ns_scale = (NSEC_PER_MSEC << NS_SCALE) / cpu_khz;
 468 }
 469
 470 static inline unsigned long long cycles_2_ns(unsigned long long cyc)
 471 {
 472         return (cyc * cyc2ns_scale) >> NS_SCALE;
 473 }
 474
 475 unsigned long long sched_clock(void)
 476 {
 477         unsigned long a = 0;
 478
 479 #if 0
 480         /* Don't do a HPET read here. Using TSC always is much faster
 481            and HPET may not be mapped yet when the scheduler first runs.
 482            Disadvantage is a small drift between CPUs in some configurations,
 483            but that should be tolerable. */
 484         if (__vxtime.mode == VXTIME_HPET)
 485                 return (hpet_readl(HPET_COUNTER) * vxtime.quot) >> US_SCALE;
 486 #endif
 487
 488         /* Could do CPU core sync here. Opteron can execute rdtsc speculatively,
 489            which means it is not completely exact and may not be monotonous between
 490            CPUs. But the errors should be too small to matter for scheduling
 491            purposes. */
 492
 493         rdtscll(a);
 494         return cycles_2_ns(a);
 495 }
 496
 497 static unsigned long get_cmos_time(void)
 498 {
 499         unsigned int year, mon, day, hour, min, sec;
 500         unsigned long flags;
 501         unsigned century = 0;
 502
 503         spin_lock_irqsave(&rtc_lock, flags);
 504
 505         do {
 506                 sec = CMOS_READ(RTC_SECONDS);
 507                 min = CMOS_READ(RTC_MINUTES);
 508                 hour = CMOS_READ(RTC_HOURS);
 509                 day = CMOS_READ(RTC_DAY_OF_MONTH);
 510                 mon = CMOS_READ(RTC_MONTH);
 511                 year = CMOS_READ(RTC_YEAR);
 512 #ifdef CONFIG_ACPI
 513                 if (acpi_gbl_FADT.header.revision >= FADT2_REVISION_ID &&
 514                                         acpi_gbl_FADT.century)
 515                         century = CMOS_READ(acpi_gbl_FADT.century);
 516 #endif
 517         } while (sec != CMOS_READ(RTC_SECONDS));
 518
 519         spin_unlock_irqrestore(&rtc_lock, flags);
 520
 521         /*
 522          * We know that x86-64 always uses BCD format, no need to check the
 523          * config register.
 524          */
 525
 526         BCD_TO_BIN(sec);
 527         BCD_TO_BIN(min);
 528         BCD_TO_BIN(hour);
 529         BCD_TO_BIN(day);
 530         BCD_TO_BIN(mon);
 531         BCD_TO_BIN(year);
 532
 533         if (century) {
 534                 BCD_TO_BIN(century);
 535                 year += century * 100;
 536                 printk(KERN_INFO "Extended CMOS year: %d\n", century * 100);
 537         } else {
 538                 /*
 539                  * x86-64 systems only exists since 2002.
 540                  * This will work up to Dec 31, 2100
 541                  */
 542                 year += 2000;
 543         }
 544
 545         return mktime(year, mon, day, hour, min, sec);
 546 }
 547
 548 #ifdef CONFIG_CPU_FREQ
 549
 550 /* Frequency scaling support. Adjust the TSC based timer when the cpu frequency
 551    changes.
 552
 553    RED-PEN: On SMP we assume all CPUs run with the same frequency.  It's
 554    not that important because current Opteron setups do not support
 555    scaling on SMP anyroads.
 556
 557    Should fix up last_tsc too. Currently gettimeofday in the
 558    first tick after the change will be slightly wrong. */
 559
 560 #include <linux/workqueue.h>
 561
 562 static unsigned int cpufreq_delayed_issched = 0;
 563 static unsigned int cpufreq_init = 0;
 564 static struct work_struct cpufreq_delayed_get_work;
 565
 566 static void handle_cpufreq_delayed_get(struct work_struct *v)
 567 {
 568         unsigned int cpu;
 569         for_each_online_cpu(cpu) {
 570                 cpufreq_get(cpu);
 571         }
 572         cpufreq_delayed_issched = 0;
 573 }
 574
 575 /* if we notice lost ticks, schedule a call to cpufreq_get() as it tries
 576  * to verify the CPU frequency the timing core thinks the CPU is running
 577  * at is still correct.
 578  */
 579 static void cpufreq_delayed_get(void)
 580 {
 581         static int warned;
 582         if (cpufreq_init && !cpufreq_delayed_issched) {
 583                 cpufreq_delayed_issched = 1;
 584                 if (!warned) {
 585                         warned = 1;
 586                         printk(KERN_DEBUG
 587         "Losing some ticks... checking if CPU frequency changed.\n");
 588                 }
 589                 schedule_work(&cpufreq_delayed_get_work);
 590         }
 591 }
 592
 593 static unsigned int  ref_freq = 0;
 594 static unsigned long loops_per_jiffy_ref = 0;
 595
 596 static unsigned long cpu_khz_ref = 0;
 597
 598 static int time_cpufreq_notifier(struct notifier_block *nb, unsigned long val,
 599                                  void *data)
 600 {
 601         struct cpufreq_freqs *freq = data;
 602         unsigned long *lpj, dummy;
 603
 604         if (cpu_has(&cpu_data[freq->cpu], X86_FEATURE_CONSTANT_TSC))
 605                 return 0;
 606
 607         lpj = &dummy;
 608         if (!(freq->flags & CPUFREQ_CONST_LOOPS))
 609 #ifdef CONFIG_SMP
 610                 lpj = &cpu_data[freq->cpu].loops_per_jiffy;
 611 #else
 612                 lpj = &boot_cpu_data.loops_per_jiffy;
 613 #endif
 614
 615         if (!ref_freq) {
 616                 ref_freq = freq->old;
 617                 loops_per_jiffy_ref = *lpj;
 618                 cpu_khz_ref = cpu_khz;
 619         }
 620         if ((val == CPUFREQ_PRECHANGE  && freq->old < freq->new) ||
 621             (val == CPUFREQ_POSTCHANGE && freq->old > freq->new) ||
 622             (val == CPUFREQ_RESUMECHANGE)) {
 623                 *lpj =
 624                 cpufreq_scale(loops_per_jiffy_ref, ref_freq, freq->new);
 625
 626                 cpu_khz = cpufreq_scale(cpu_khz_ref, ref_freq, freq->new);
 627                 if (!(freq->flags & CPUFREQ_CONST_LOOPS))
 628                         vxtime.tsc_quot = (USEC_PER_MSEC << US_SCALE) / cpu_khz;
 629         }
 630
 631         set_cyc2ns_scale(cpu_khz_ref);
 632
 633         return 0;
 634 }
 635
 636 static struct notifier_block time_cpufreq_notifier_block = {
 637          .notifier_call  = time_cpufreq_notifier
 638 };
 639
 640 static int __init cpufreq_tsc(void)
 641 {
 642         INIT_WORK(&cpufreq_delayed_get_work, handle_cpufreq_delayed_get);
 643         if (!cpufreq_register_notifier(&time_cpufreq_notifier_block,
 644                                        CPUFREQ_TRANSITION_NOTIFIER))
 645                 cpufreq_init = 1;
 646         return 0;
 647 }
 648
 649 core_initcall(cpufreq_tsc);
 650
 651 #endif
 652
 653 /*
 654  * calibrate_tsc() calibrates the processor TSC in a very simple way, comparing
 655  * it to the HPET timer of known frequency.
 656  */
 657
 658 #define TICK_COUNT 100000000
 659 #define TICK_MIN   5000
 660
 661 /*
 662  * Some platforms take periodic SMI interrupts with 5ms duration. Make sure none
 663  * occurs between the reads of the hpet & TSC.
 664  */
 665 static void __init read_hpet_tsc(int *hpet, int *tsc)
 666 {
 667         int tsc1, tsc2, hpet1;
 668
 669         do {
 670                 tsc1 = get_cycles_sync();
 671                 hpet1 = hpet_readl(HPET_COUNTER);
 672                 tsc2 = get_cycles_sync();
 673         } while (tsc2 - tsc1 > TICK_MIN);
 674         *hpet = hpet1;
 675         *tsc = tsc2;
 676 }
 677
 678
 679 static unsigned int __init hpet_calibrate_tsc(void)
 680 {
 681         int tsc_start, hpet_start;
 682         int tsc_now, hpet_now;
 683         unsigned long flags;
 684
 685         local_irq_save(flags);
 686         local_irq_disable();
 687
 688         read_hpet_tsc(&hpet_start, &tsc_start);
 689
 690         do {
 691                 local_irq_disable();
 692                 read_hpet_tsc(&hpet_now, &tsc_now);
 693                 local_irq_restore(flags);
 694         } while ((tsc_now - tsc_start) < TICK_COUNT &&
 695                  (hpet_now - hpet_start) < TICK_COUNT);
 696
 697         return (tsc_now - tsc_start) * 1000000000L
 698                 / ((hpet_now - hpet_start) * hpet_period / 1000);
 699 }
 700
 701
 702 /*
 703  * pit_calibrate_tsc() uses the speaker output (channel 2) of
 704  * the PIT. This is better than using the timer interrupt output,
 705  * because we can read the value of the speaker with just one inb(),
 706  * where we need three i/o operations for the interrupt channel.
 707  * We count how many ticks the TSC does in 50 ms.
 708  */
 709
 710 static unsigned int __init pit_calibrate_tsc(void)
 711 {
 712         unsigned long start, end;
 713         unsigned long flags;
 714
 715         spin_lock_irqsave(&i8253_lock, flags);
 716
 717         outb((inb(0x61) & ~0x02) | 0x01, 0x61);
 718
 719         outb(0xb0, 0x43);
 720         outb((PIT_TICK_RATE / (1000 / 50)) & 0xff, 0x42);
 721         outb((PIT_TICK_RATE / (1000 / 50)) >> 8, 0x42);
 722         start = get_cycles_sync();
 723         while ((inb(0x61) & 0x20) == 0);
 724         end = get_cycles_sync();
 725
 726         spin_unlock_irqrestore(&i8253_lock, flags);
 727
 728         return (end - start) / 50;
 729 }
 730
 731 #ifdef  CONFIG_HPET
 732 static __init int late_hpet_init(void)
 733 {
 734         struct hpet_data        hd;
 735         unsigned int            ntimer;
 736
 737         if (!vxtime.hpet_address)
 738                 return 0;
 739
 740         memset(&hd, 0, sizeof (hd));
 741
 742         ntimer = hpet_readl(HPET_ID);
 743         ntimer = (ntimer & HPET_ID_NUMBER) >> HPET_ID_NUMBER_SHIFT;
 744         ntimer++;
 745
 746         /*
 747          * Register with driver.
 748          * Timer0 and Timer1 is used by platform.
 749          */
 750         hd.hd_phys_address = vxtime.hpet_address;
 751         hd.hd_address = (void __iomem *)fix_to_virt(FIX_HPET_BASE);
 752         hd.hd_nirqs = ntimer;
 753         hd.hd_flags = HPET_DATA_PLATFORM;
 754         hpet_reserve_timer(&hd, 0);
 755 #ifdef  CONFIG_HPET_EMULATE_RTC
 756         hpet_reserve_timer(&hd, 1);
 757 #endif
 758         hd.hd_irq[0] = HPET_LEGACY_8254;
 759         hd.hd_irq[1] = HPET_LEGACY_RTC;
 760         if (ntimer > 2) {
 761                 struct hpet             *hpet;
 762                 struct hpet_timer       *timer;
 763                 int                     i;
 764
 765                 hpet = (struct hpet *) fix_to_virt(FIX_HPET_BASE);
 766                 timer = &hpet->hpet_timers[2];
 767                 for (i = 2; i < ntimer; timer++, i++)
 768                         hd.hd_irq[i] = (timer->hpet_config &
 769                                         Tn_INT_ROUTE_CNF_MASK) >>
 770                                 Tn_INT_ROUTE_CNF_SHIFT;
 771
 772         }
 773
 774         hpet_alloc(&hd);
 775         return 0;
 776 }
 777 fs_initcall(late_hpet_init);
 778 #endif
 779
 780 static int hpet_timer_stop_set_go(unsigned long tick)
 781 {
 782         unsigned int cfg;
 783
 784 /*
 785  * Stop the timers and reset the main counter.
 786  */
 787
 788         cfg = hpet_readl(HPET_CFG);
 789         cfg &= ~(HPET_CFG_ENABLE | HPET_CFG_LEGACY);
 790         hpet_writel(cfg, HPET_CFG);
 791         hpet_writel(0, HPET_COUNTER);
 792         hpet_writel(0, HPET_COUNTER + 4);
 793
 794 /*
 795  * Set up timer 0, as periodic with first interrupt to happen at hpet_tick,
 796  * and period also hpet_tick.
 797  */
 798         if (hpet_use_timer) {
 799                 hpet_writel(HPET_TN_ENABLE | HPET_TN_PERIODIC | HPET_TN_SETVAL |
 800                     HPET_TN_32BIT, HPET_T0_CFG);
 801                 hpet_writel(hpet_tick, HPET_T0_CMP); /* next interrupt */
 802                 hpet_writel(hpet_tick, HPET_T0_CMP); /* period */
 803                 cfg |= HPET_CFG_LEGACY;
 804         }
 805 /*
 806  * Go!
 807  */
 808
 809         cfg |= HPET_CFG_ENABLE;
 810         hpet_writel(cfg, HPET_CFG);
 811
 812         return 0;
 813 }
 814
 815 static int hpet_init(void)
 816 {
 817         unsigned int id;
 818
 819         if (!vxtime.hpet_address)
 820                 return -1;
 821         set_fixmap_nocache(FIX_HPET_BASE, vxtime.hpet_address);
 822         __set_fixmap(VSYSCALL_HPET, vxtime.hpet_address, PAGE_KERNEL_VSYSCALL_NOCACHE);
 823
 824 /*
 825  * Read the period, compute tick and quotient.
 826  */
 827
 828         id = hpet_readl(HPET_ID);
 829
 830         if (!(id & HPET_ID_VENDOR) || !(id & HPET_ID_NUMBER))
 831                 return -1;
 832
 833         hpet_period = hpet_readl(HPET_PERIOD);
 834         if (hpet_period < 100000 || hpet_period > 100000000)
 835                 return -1;
 836
 837         hpet_tick = (FSEC_PER_TICK + hpet_period / 2) / hpet_period;
 838
 839         hpet_use_timer = (id & HPET_ID_LEGSUP);
 840
 841         return hpet_timer_stop_set_go(hpet_tick);
 842 }
 843
 844 static int hpet_reenable(void)
 845 {
 846         return hpet_timer_stop_set_go(hpet_tick);
 847 }
 848
 849 #define PIT_MODE 0x43
 850 #define PIT_CH0  0x40
 851
 852 static void __init __pit_init(int val, u8 mode)
 853 {
 854         unsigned long flags;
 855
 856         spin_lock_irqsave(&i8253_lock, flags);
 857         outb_p(mode, PIT_MODE);
 858         outb_p(val & 0xff, PIT_CH0);    /* LSB */
 859         outb_p(val >> 8, PIT_CH0);      /* MSB */
 860         spin_unlock_irqrestore(&i8253_lock, flags);
 861 }
 862
 863 void __init pit_init(void)
 864 {
 865         __pit_init(LATCH, 0x34); /* binary, mode 2, LSB/MSB, ch 0 */
 866 }
 867
 868 void __init pit_stop_interrupt(void)
 869 {
 870         __pit_init(0, 0x30); /* mode 0 */
 871 }
 872
 873 void __init stop_timer_interrupt(void)
 874 {
 875         char *name;
 876         if (vxtime.hpet_address) {
 877                 name = "HPET";
 878                 hpet_timer_stop_set_go(0);
 879         } else {
 880                 name = "PIT";
 881                 pit_stop_interrupt();
 882         }
 883         printk(KERN_INFO "timer: %s interrupt stopped.\n", name);
 884 }
 885
 886 int __init time_setup(char *str)
 887 {
 888         report_lost_ticks = 1;
 889         return 1;
 890 }
 891
 892 static struct irqaction irq0 = {
 893         timer_interrupt, IRQF_DISABLED, CPU_MASK_NONE, "timer", NULL, NULL
 894 };
 895
 896 void __init time_init(void)
 897 {
 898         if (nohpet)
 899                 vxtime.hpet_address = 0;
 900
 901         xtime.tv_sec = get_cmos_time();
 902         xtime.tv_nsec = 0;
 903
 904         set_normalized_timespec(&wall_to_monotonic,
 905                                 -xtime.tv_sec, -xtime.tv_nsec);
 906
 907         if (!hpet_init())
 908                 vxtime_hz = (FSEC_PER_SEC + hpet_period / 2) / hpet_period;
 909         else
 910                 vxtime.hpet_address = 0;
 911
 912         if (hpet_use_timer) {
 913                 /* set tick_nsec to use the proper rate for HPET */
 914                 tick_nsec = TICK_NSEC_HPET;
 915                 cpu_khz = hpet_calibrate_tsc();
 916                 timename = "HPET";
 917 #ifdef CONFIG_X86_PM_TIMER
 918         } else if (pmtmr_ioport && !vxtime.hpet_address) {
 919                 vxtime_hz = PM_TIMER_FREQUENCY;
 920                 timename = "PM";
 921                 pit_init();
 922                 cpu_khz = pit_calibrate_tsc();
 923 #endif
 924         } else {
 925                 pit_init();
 926                 cpu_khz = pit_calibrate_tsc();
 927                 timename = "PIT";
 928         }
 929
 930         vxtime.mode = VXTIME_TSC;
 931         vxtime.quot = (USEC_PER_SEC << US_SCALE) / vxtime_hz;
 932         vxtime.tsc_quot = (USEC_PER_MSEC << US_SCALE) / cpu_khz;
 933         vxtime.last_tsc = get_cycles_sync();
 934         set_cyc2ns_scale(cpu_khz);
 935         setup_irq(0, &irq0);
 936
 937 #ifndef CONFIG_SMP
 938         time_init_gtod();
 939 #endif
 940 }
 941
 942 /*
 943  * Make an educated guess if the TSC is trustworthy and synchronized
 944  * over all CPUs.
 945  */
 946 __cpuinit int unsynchronized_tsc(void)
 947 {
 948 #ifdef CONFIG_SMP
 949         if (apic_is_clustered_box())
 950                 return 1;
 951 #endif
 952         /* Most intel systems have synchronized TSCs except for
 953            multi node systems */
 954         if (boot_cpu_data.x86_vendor == X86_VENDOR_INTEL) {
 955 #ifdef CONFIG_ACPI
 956                 /* But TSC doesn't tick in C3 so don't use it there */
 957                 if (acpi_gbl_FADT.header.length > 0 && acpi_gbl_FADT.C3latency < 1000)
 958                         return 1;
 959 #endif
 960                 return 0;
 961         }
 962
 963         /* Assume multi socket systems are not synchronized */
 964         return num_present_cpus() > 1;
 965 }
 966
 967 /*
 968  * Decide what mode gettimeofday should use.
 969  */
 970 void time_init_gtod(void)
 971 {
 972         char *timetype;
 973
 974         if (unsynchronized_tsc())
 975                 notsc = 1;
 976
 977         if (cpu_has(&boot_cpu_data, X86_FEATURE_RDTSCP))
 978                 vgetcpu_mode = VGETCPU_RDTSCP;
 979         else
 980                 vgetcpu_mode = VGETCPU_LSL;
 981
 982         if (vxtime.hpet_address && notsc) {
 983                 timetype = hpet_use_timer ? "HPET" : "PIT/HPET";
 984                 if (hpet_use_timer)
 985                         vxtime.last = hpet_readl(HPET_T0_CMP) - hpet_tick;
 986                 else
 987                         vxtime.last = hpet_readl(HPET_COUNTER);
 988                 vxtime.mode = VXTIME_HPET;
 989                 do_gettimeoffset = do_gettimeoffset_hpet;
 990 #ifdef CONFIG_X86_PM_TIMER
 991         /* Using PM for gettimeofday is quite slow, but we have no other
 992            choice because the TSC is too unreliable on some systems. */
 993         } else if (pmtmr_ioport && !vxtime.hpet_address && notsc) {
 994                 timetype = "PM";
 995                 do_gettimeoffset = do_gettimeoffset_pm;
 996                 vxtime.mode = VXTIME_PMTMR;
 997                 sysctl_vsyscall = 0;
 998                 printk(KERN_INFO "Disabling vsyscall due to use of PM timer\n");
 999 #endif
1000         } else {
1001                 timetype = hpet_use_timer ? "HPET/TSC" : "PIT/TSC";
1002                 vxtime.mode = VXTIME_TSC;
1003         }
1004
1005         printk(KERN_INFO "time.c: Using %ld.%06ld MHz WALL %s GTOD %s timer.\n",
1006                vxtime_hz / 1000000, vxtime_hz % 1000000, timename, timetype);
1007         printk(KERN_INFO "time.c: Detected %d.%03d MHz processor.\n",
1008                 cpu_khz / 1000, cpu_khz % 1000);
1009         vxtime.quot = (USEC_PER_SEC << US_SCALE) / vxtime_hz;
1010         vxtime.tsc_quot = (USEC_PER_MSEC << US_SCALE) / cpu_khz;
1011         vxtime.last_tsc = get_cycles_sync();
1012
1013         set_cyc2ns_scale(cpu_khz);
1014 }
1015
1016 __setup("report_lost_ticks", time_setup);
1017
1018 static long clock_cmos_diff;
1019 static unsigned long sleep_start;
1020
1021 /*
1022  * sysfs support for the timer.
1023  */
1024
1025 static int timer_suspend(struct sys_device *dev, pm_message_t state)
1026 {
1027         /*
1028          * Estimate time zone so that set_time can update the clock
1029          */
1030         long cmos_time =  get_cmos_time();
1031
1032         clock_cmos_diff = -cmos_time;
1033         clock_cmos_diff += get_seconds();
1034         sleep_start = cmos_time;
1035         return 0;
1036 }
1037
1038 static int timer_resume(struct sys_device *dev)
1039 {
1040         unsigned long flags;
1041         unsigned long sec;
1042         unsigned long ctime = get_cmos_time();
1043         long sleep_length = (ctime - sleep_start) * HZ;
1044
1045         if (sleep_length < 0) {
1046                 printk(KERN_WARNING "Time skew detected in timer resume!\n");
1047                 /* The time after the resume must not be earlier than the time
1048                  * before the suspend or some nasty things will happen
1049                  */
1050                 sleep_length = 0;
1051                 ctime = sleep_start;
1052         }
1053         if (vxtime.hpet_address)
1054                 hpet_reenable();
1055         else
1056                 i8254_timer_resume();
1057
1058         sec = ctime + clock_cmos_diff;
1059         write_seqlock_irqsave(&xtime_lock,flags);
1060         xtime.tv_sec = sec;
1061         xtime.tv_nsec = 0;
1062         if (vxtime.mode == VXTIME_HPET) {
1063                 if (hpet_use_timer)
1064                         vxtime.last = hpet_readl(HPET_T0_CMP) - hpet_tick;
1065                 else
1066                         vxtime.last = hpet_readl(HPET_COUNTER);
1067 #ifdef CONFIG_X86_PM_TIMER
1068         } else if (vxtime.mode == VXTIME_PMTMR) {
1069                 pmtimer_resume();
1070 #endif
1071         } else
1072                 vxtime.last_tsc = get_cycles_sync();
1073         write_sequnlock_irqrestore(&xtime_lock,flags);
1074         jiffies += sleep_length;
1075         monotonic_base += sleep_length * (NSEC_PER_SEC/HZ);
1076         touch_softlockup_watchdog();
1077         return 0;
1078 }
1079
1080 static struct sysdev_class timer_sysclass = {
1081         .resume = timer_resume,
1082         .suspend = timer_suspend,
1083         set_kset_name("timer"),
1084 };
1085
1086 /* XXX this driverfs stuff should probably go elsewhere later -john */
1087 static struct sys_device device_timer = {
1088         .id     = 0,
1089         .cls    = &timer_sysclass,
1090 };
1091
1092 static int time_init_device(void)
1093 {
1094         int error = sysdev_class_register(&timer_sysclass);
1095         if (!error)
1096                 error = sysdev_register(&device_timer);
1097         return error;
1098 }
1099
1100 device_initcall(time_init_device);
1101
1102 #ifdef CONFIG_HPET_EMULATE_RTC
1103 /* HPET in LegacyReplacement Mode eats up RTC interrupt line. When, HPET
1104  * is enabled, we support RTC interrupt functionality in software.
1105  * RTC has 3 kinds of interrupts:
1106  * 1) Update Interrupt - generate an interrupt, every sec, when RTC clock
1107  *    is updated
1108  * 2) Alarm Interrupt - generate an interrupt at a specific time of day
1109  * 3) Periodic Interrupt - generate periodic interrupt, with frequencies
1110  *    2Hz-8192Hz (2Hz-64Hz for non-root user) (all freqs in powers of 2)
1111  * (1) and (2) above are implemented using polling at a frequency of
1112  * 64 Hz. The exact frequency is a tradeoff between accuracy and interrupt
1113  * overhead. (DEFAULT_RTC_INT_FREQ)
1114  * For (3), we use interrupts at 64Hz or user specified periodic
1115  * frequency, whichever is higher.
1116  */
1117 #include <linux/rtc.h>
1118
1119 #define DEFAULT_RTC_INT_FREQ    64
1120 #define RTC_NUM_INTS            1
1121
1122 static unsigned long UIE_on;
1123 static unsigned long prev_update_sec;
1124
1125 static unsigned long AIE_on;
1126 static struct rtc_time alarm_time;
1127
1128 static unsigned long PIE_on;
1129 static unsigned long PIE_freq = DEFAULT_RTC_INT_FREQ;
1130 static unsigned long PIE_count;
1131
1132 static unsigned long hpet_rtc_int_freq; /* RTC interrupt frequency */
1133 static unsigned int hpet_t1_cmp; /* cached comparator register */
1134
1135 int is_hpet_enabled(void)
1136 {
1137         return vxtime.hpet_address != 0;
1138 }
1139
1140 /*
1141  * Timer 1 for RTC, we do not use periodic interrupt feature,
1142  * even if HPET supports periodic interrupts on Timer 1.
1143  * The reason being, to set up a periodic interrupt in HPET, we need to
1144  * stop the main counter. And if we do that everytime someone diables/enables
1145  * RTC, we will have adverse effect on main kernel timer running on Timer 0.
1146  * So, for the time being, simulate the periodic interrupt in software.
1147  *
1148  * hpet_rtc_timer_init() is called for the first time and during subsequent
1149  * interuppts reinit happens through hpet_rtc_timer_reinit().
1150  */
1151 int hpet_rtc_timer_init(void)
1152 {
1153         unsigned int cfg, cnt;
1154         unsigned long flags;
1155
1156         if (!is_hpet_enabled())
1157                 return 0;
1158         /*
1159          * Set the counter 1 and enable the interrupts.
1160          */
1161         if (PIE_on && (PIE_freq > DEFAULT_RTC_INT_FREQ))
1162                 hpet_rtc_int_freq = PIE_freq;
1163         else
1164                 hpet_rtc_int_freq = DEFAULT_RTC_INT_FREQ;
1165
1166         local_irq_save(flags);
1167
1168         cnt = hpet_readl(HPET_COUNTER);
1169         cnt += ((hpet_tick*HZ)/hpet_rtc_int_freq);
1170         hpet_writel(cnt, HPET_T1_CMP);
1171         hpet_t1_cmp = cnt;
1172
1173         cfg = hpet_readl(HPET_T1_CFG);
1174         cfg &= ~HPET_TN_PERIODIC;
1175         cfg |= HPET_TN_ENABLE | HPET_TN_32BIT;
1176         hpet_writel(cfg, HPET_T1_CFG);
1177
1178         local_irq_restore(flags);
1179
1180         return 1;
1181 }
1182
1183 static void hpet_rtc_timer_reinit(void)
1184 {
1185         unsigned int cfg, cnt, ticks_per_int, lost_ints;
1186
1187         if (unlikely(!(PIE_on | AIE_on | UIE_on))) {
1188                 cfg = hpet_readl(HPET_T1_CFG);
1189                 cfg &= ~HPET_TN_ENABLE;
1190                 hpet_writel(cfg, HPET_T1_CFG);
1191                 return;
1192         }
1193
1194         if (PIE_on && (PIE_freq > DEFAULT_RTC_INT_FREQ))
1195                 hpet_rtc_int_freq = PIE_freq;
1196         else
1197                 hpet_rtc_int_freq = DEFAULT_RTC_INT_FREQ;
1198
1199         /* It is more accurate to use the comparator value than current count.*/
1200         ticks_per_int = hpet_tick * HZ / hpet_rtc_int_freq;
1201         hpet_t1_cmp += ticks_per_int;
1202         hpet_writel(hpet_t1_cmp, HPET_T1_CMP);
1203
1204         /*
1205          * If the interrupt handler was delayed too long, the write above tries
1206          * to schedule the next interrupt in the past and the hardware would
1207          * not interrupt until the counter had wrapped around.
1208          * So we have to check that the comparator wasn't set to a past time.
1209          */
1210         cnt = hpet_readl(HPET_COUNTER);
1211         if (unlikely((int)(cnt - hpet_t1_cmp) > 0)) {
1212                 lost_ints = (cnt - hpet_t1_cmp) / ticks_per_int + 1;
1213                 /* Make sure that, even with the time needed to execute
1214                  * this code, the next scheduled interrupt has been moved
1215                  * back to the future: */
1216                 lost_ints++;
1217
1218                 hpet_t1_cmp += lost_ints * ticks_per_int;
1219                 hpet_writel(hpet_t1_cmp, HPET_T1_CMP);
1220
1221                 if (PIE_on)
1222                         PIE_count += lost_ints;
1223
1224                 printk(KERN_WARNING "rtc: lost some interrupts at %ldHz.\n",
1225                        hpet_rtc_int_freq);
1226         }
1227 }
1228
1229 /*
1230  * The functions below are called from rtc driver.
1231  * Return 0 if HPET is not being used.
1232  * Otherwise do the necessary changes and return 1.
1233  */
1234 int hpet_mask_rtc_irq_bit(unsigned long bit_mask)
1235 {
1236         if (!is_hpet_enabled())
1237                 return 0;
1238
1239         if (bit_mask & RTC_UIE)
1240                 UIE_on = 0;
1241         if (bit_mask & RTC_PIE)
1242                 PIE_on = 0;
1243         if (bit_mask & RTC_AIE)
1244                 AIE_on = 0;
1245
1246         return 1;
1247 }
1248
1249 int hpet_set_rtc_irq_bit(unsigned long bit_mask)
1250 {
1251         int timer_init_reqd = 0;
1252
1253         if (!is_hpet_enabled())
1254                 return 0;
1255
1256         if (!(PIE_on | AIE_on | UIE_on))
1257                 timer_init_reqd = 1;
1258
1259         if (bit_mask & RTC_UIE) {
1260                 UIE_on = 1;
1261         }
1262         if (bit_mask & RTC_PIE) {
1263                 PIE_on = 1;
1264                 PIE_count = 0;
1265         }
1266         if (bit_mask & RTC_AIE) {
1267                 AIE_on = 1;
1268         }
1269
1270         if (timer_init_reqd)
1271                 hpet_rtc_timer_init();
1272
1273         return 1;
1274 }
1275
1276 int hpet_set_alarm_time(unsigned char hrs, unsigned char min, unsigned char sec)
1277 {
1278         if (!is_hpet_enabled())
1279                 return 0;
1280
1281         alarm_time.tm_hour = hrs;
1282         alarm_time.tm_min = min;
1283         alarm_time.tm_sec = sec;
1284
1285         return 1;
1286 }
1287
1288 int hpet_set_periodic_freq(unsigned long freq)
1289 {
1290         if (!is_hpet_enabled())
1291                 return 0;
1292
1293         PIE_freq = freq;
1294         PIE_count = 0;
1295
1296         return 1;
1297 }
1298
1299 int hpet_rtc_dropped_irq(void)
1300 {
1301         if (!is_hpet_enabled())
1302                 return 0;
1303
1304         return 1;
1305 }
1306
1307 irqreturn_t hpet_rtc_interrupt(int irq, void *dev_id, struct pt_regs *regs)
1308 {
1309         struct rtc_time curr_time;
1310         unsigned long rtc_int_flag = 0;
1311         int call_rtc_interrupt = 0;
1312
1313         hpet_rtc_timer_reinit();
1314
1315         if (UIE_on | AIE_on) {
1316                 rtc_get_rtc_time(&curr_time);
1317         }
1318         if (UIE_on) {
1319                 if (curr_time.tm_sec != prev_update_sec) {
1320                         /* Set update int info, call real rtc int routine */
1321                         call_rtc_interrupt = 1;
1322                         rtc_int_flag = RTC_UF;
1323                         prev_update_sec = curr_time.tm_sec;
1324                 }
1325         }
1326         if (PIE_on) {
1327                 PIE_count++;
1328                 if (PIE_count >= hpet_rtc_int_freq/PIE_freq) {
1329                         /* Set periodic int info, call real rtc int routine */
1330                         call_rtc_interrupt = 1;
1331                         rtc_int_flag |= RTC_PF;
1332                         PIE_count = 0;
1333                 }
1334         }
1335         if (AIE_on) {
1336                 if ((curr_time.tm_sec == alarm_time.tm_sec) &&
1337                     (curr_time.tm_min == alarm_time.tm_min) &&
1338                     (curr_time.tm_hour == alarm_time.tm_hour)) {
1339                         /* Set alarm int info, call real rtc int routine */
1340                         call_rtc_interrupt = 1;
1341                         rtc_int_flag |= RTC_AF;
1342                 }
1343         }
1344         if (call_rtc_interrupt) {
1345                 rtc_int_flag |= (RTC_IRQF | (RTC_NUM_INTS << 8));
1346                 rtc_interrupt(rtc_int_flag, dev_id);
1347         }
1348         return IRQ_HANDLED;
1349 }
1350 #endif
1351
1352 static int __init nohpet_setup(char *s)
1353 {
1354         nohpet = 1;
1355         return 1;
1356 }
1357
1358 __setup("nohpet", nohpet_setup);
1359
1360 int __init notsc_setup(char *s)
1361 {
1362         notsc = 1;
1363         return 1;
1364 }
1365
1366 __setup("notsc", notsc_setup);