3 * Common time routines among all ppc machines.
5 * Written by Cort Dougan (cort@cs.nmt.edu) to merge
6 * Paul Mackerras' version and mine for PReP and Pmac.
7 * MPC8xx/MBX changes by Dan Malek (dmalek@jlc.net).
8 * Converted for 64-bit by Mike Corrigan (mikejc@us.ibm.com)
10 * First round of bugfixes by Gabriel Paubert (paubert@iram.es)
11 * to make clock more stable (2.4.0-test5). The only thing
12 * that this code assumes is that the timebases have been synchronized
13 * by firmware on SMP and are never stopped (never do sleep
14 * on SMP then, nap and doze are OK).
16 * Speeded up do_gettimeofday by getting rid of references to
17 * xtime (which required locks for consistency). (mikejc@us.ibm.com)
19 * TODO (not necessarily in this file):
20 * - improve precision and reproducibility of timebase frequency
21 * measurement at boot time. (for iSeries, we calibrate the timebase
22 * against the Titan chip's clock.)
23 * - for astronomical applications: add a new function to get
24 * non ambiguous timestamps even around leap seconds. This needs
25 * a new timestamp format and a good name.
27 * 1997-09-10 Updated NTP code according to technical memorandum Jan '96
28 * "A Kernel Model for Precision Timekeeping" by Dave Mills
30 * This program is free software; you can redistribute it and/or
31 * modify it under the terms of the GNU General Public License
32 * as published by the Free Software Foundation; either version
33 * 2 of the License, or (at your option) any later version.
36 #include <linux/config.h>
37 #include <linux/errno.h>
38 #include <linux/module.h>
39 #include <linux/sched.h>
40 #include <linux/kernel.h>
41 #include <linux/param.h>
42 #include <linux/string.h>
44 #include <linux/interrupt.h>
45 #include <linux/timex.h>
46 #include <linux/kernel_stat.h>
47 #include <linux/mc146818rtc.h>
48 #include <linux/time.h>
49 #include <linux/init.h>
50 #include <linux/profile.h>
51 #include <linux/cpu.h>
52 #include <linux/security.h>
55 #include <asm/processor.h>
56 #include <asm/nvram.h>
57 #include <asm/cache.h>
58 #include <asm/machdep.h>
59 #ifdef CONFIG_PPC_ISERIES
60 #include <asm/iSeries/ItLpQueue.h>
61 #include <asm/iSeries/HvCallXm.h>
63 #include <asm/uaccess.h>
65 #include <asm/ppcdebug.h>
67 #include <asm/sections.h>
68 #include <asm/systemcfg.h>
69 #include <asm/firmware.h>
71 u64 jiffies_64 __cacheline_aligned_in_smp
= INITIAL_JIFFIES
;
73 EXPORT_SYMBOL(jiffies_64
);
75 /* keep track of when we need to update the rtc */
76 time_t last_rtc_update
;
77 extern int piranha_simulator
;
78 #ifdef CONFIG_PPC_ISERIES
79 unsigned long iSeries_recal_titan
= 0;
80 unsigned long iSeries_recal_tb
= 0;
81 static unsigned long first_settimeofday
= 1;
84 #define XSEC_PER_SEC (1024*1024)
86 unsigned long tb_ticks_per_jiffy
;
87 unsigned long tb_ticks_per_usec
= 100; /* sane default */
88 EXPORT_SYMBOL(tb_ticks_per_usec
);
89 unsigned long tb_ticks_per_sec
;
90 unsigned long tb_to_xs
;
92 unsigned long processor_freq
;
93 DEFINE_SPINLOCK(rtc_lock
);
94 EXPORT_SYMBOL_GPL(rtc_lock
);
96 unsigned long tb_to_ns_scale
;
97 unsigned long tb_to_ns_shift
;
99 struct gettimeofday_struct do_gtod
;
101 extern unsigned long wall_jiffies
;
102 extern int smp_tb_synchronized
;
104 extern struct timezone sys_tz
;
106 void ppc_adjtimex(void);
108 static unsigned adjusting_time
= 0;
110 unsigned long ppc_proc_freq
;
111 unsigned long ppc_tb_freq
;
113 static __inline__
void timer_check_rtc(void)
116 * update the rtc when needed, this should be performed on the
117 * right fraction of a second. Half or full second ?
118 * Full second works on mk48t59 clocks, others need testing.
119 * Note that this update is basically only used through
120 * the adjtimex system calls. Setting the HW clock in
121 * any other way is a /dev/rtc and userland business.
122 * This is still wrong by -0.5/+1.5 jiffies because of the
123 * timer interrupt resolution and possible delay, but here we
124 * hit a quantization limit which can only be solved by higher
125 * resolution timers and decoupling time management from timer
126 * interrupts. This is also wrong on the clocks
127 * which require being written at the half second boundary.
128 * We should have an rtc call that only sets the minutes and
129 * seconds like on Intel to avoid problems with non UTC clocks.
132 xtime
.tv_sec
- last_rtc_update
>= 659 &&
133 abs((xtime
.tv_nsec
/1000) - (1000000-1000000/HZ
)) < 500000/HZ
&&
134 jiffies
- wall_jiffies
== 1) {
136 to_tm(xtime
.tv_sec
+1, &tm
);
139 if (ppc_md
.set_rtc_time(&tm
) == 0)
140 last_rtc_update
= xtime
.tv_sec
+1;
142 /* Try again one minute later */
143 last_rtc_update
+= 60;
148 * This version of gettimeofday has microsecond resolution.
150 static inline void __do_gettimeofday(struct timeval
*tv
, unsigned long tb_val
)
152 unsigned long sec
, usec
, tb_ticks
;
153 unsigned long xsec
, tb_xsec
;
154 struct gettimeofday_vars
* temp_varp
;
155 unsigned long temp_tb_to_xs
, temp_stamp_xsec
;
158 * These calculations are faster (gets rid of divides)
159 * if done in units of 1/2^20 rather than microseconds.
160 * The conversion to microseconds at the end is done
161 * without a divide (and in fact, without a multiply)
163 temp_varp
= do_gtod
.varp
;
164 tb_ticks
= tb_val
- temp_varp
->tb_orig_stamp
;
165 temp_tb_to_xs
= temp_varp
->tb_to_xs
;
166 temp_stamp_xsec
= temp_varp
->stamp_xsec
;
167 tb_xsec
= mulhdu( tb_ticks
, temp_tb_to_xs
);
168 xsec
= temp_stamp_xsec
+ tb_xsec
;
169 sec
= xsec
/ XSEC_PER_SEC
;
170 xsec
-= sec
* XSEC_PER_SEC
;
171 usec
= (xsec
* USEC_PER_SEC
)/XSEC_PER_SEC
;
177 void do_gettimeofday(struct timeval
*tv
)
179 __do_gettimeofday(tv
, get_tb());
182 EXPORT_SYMBOL(do_gettimeofday
);
184 /* Synchronize xtime with do_gettimeofday */
186 static inline void timer_sync_xtime(unsigned long cur_tb
)
188 struct timeval my_tv
;
190 __do_gettimeofday(&my_tv
, cur_tb
);
192 if (xtime
.tv_sec
<= my_tv
.tv_sec
) {
193 xtime
.tv_sec
= my_tv
.tv_sec
;
194 xtime
.tv_nsec
= my_tv
.tv_usec
* 1000;
199 * When the timebase - tb_orig_stamp gets too big, we do a manipulation
200 * between tb_orig_stamp and stamp_xsec. The goal here is to keep the
201 * difference tb - tb_orig_stamp small enough to always fit inside a
202 * 32 bits number. This is a requirement of our fast 32 bits userland
203 * implementation in the vdso. If we "miss" a call to this function
204 * (interrupt latency, CPU locked in a spinlock, ...) and we end up
205 * with a too big difference, then the vdso will fallback to calling
208 static __inline__
void timer_recalc_offset(unsigned long cur_tb
)
210 struct gettimeofday_vars
* temp_varp
;
212 unsigned long offset
, new_stamp_xsec
, new_tb_orig_stamp
;
214 if (((cur_tb
- do_gtod
.varp
->tb_orig_stamp
) & 0x80000000u
) == 0)
217 temp_idx
= (do_gtod
.var_idx
== 0);
218 temp_varp
= &do_gtod
.vars
[temp_idx
];
220 new_tb_orig_stamp
= cur_tb
;
221 offset
= new_tb_orig_stamp
- do_gtod
.varp
->tb_orig_stamp
;
222 new_stamp_xsec
= do_gtod
.varp
->stamp_xsec
+ mulhdu(offset
, do_gtod
.varp
->tb_to_xs
);
224 temp_varp
->tb_to_xs
= do_gtod
.varp
->tb_to_xs
;
225 temp_varp
->tb_orig_stamp
= new_tb_orig_stamp
;
226 temp_varp
->stamp_xsec
= new_stamp_xsec
;
228 do_gtod
.varp
= temp_varp
;
229 do_gtod
.var_idx
= temp_idx
;
231 ++(systemcfg
->tb_update_count
);
233 systemcfg
->tb_orig_stamp
= new_tb_orig_stamp
;
234 systemcfg
->stamp_xsec
= new_stamp_xsec
;
236 ++(systemcfg
->tb_update_count
);
240 unsigned long profile_pc(struct pt_regs
*regs
)
242 unsigned long pc
= instruction_pointer(regs
);
244 if (in_lock_functions(pc
))
249 EXPORT_SYMBOL(profile_pc
);
252 #ifdef CONFIG_PPC_ISERIES
255 * This function recalibrates the timebase based on the 49-bit time-of-day
256 * value in the Titan chip. The Titan is much more accurate than the value
257 * returned by the service processor for the timebase frequency.
260 static void iSeries_tb_recal(void)
262 struct div_result divres
;
263 unsigned long titan
, tb
;
265 titan
= HvCallXm_loadTod();
266 if ( iSeries_recal_titan
) {
267 unsigned long tb_ticks
= tb
- iSeries_recal_tb
;
268 unsigned long titan_usec
= (titan
- iSeries_recal_titan
) >> 12;
269 unsigned long new_tb_ticks_per_sec
= (tb_ticks
* USEC_PER_SEC
)/titan_usec
;
270 unsigned long new_tb_ticks_per_jiffy
= (new_tb_ticks_per_sec
+(HZ
/2))/HZ
;
271 long tick_diff
= new_tb_ticks_per_jiffy
- tb_ticks_per_jiffy
;
273 /* make sure tb_ticks_per_sec and tb_ticks_per_jiffy are consistent */
274 new_tb_ticks_per_sec
= new_tb_ticks_per_jiffy
* HZ
;
276 if ( tick_diff
< 0 ) {
277 tick_diff
= -tick_diff
;
281 if ( tick_diff
< tb_ticks_per_jiffy
/25 ) {
282 printk( "Titan recalibrate: new tb_ticks_per_jiffy = %lu (%c%ld)\n",
283 new_tb_ticks_per_jiffy
, sign
, tick_diff
);
284 tb_ticks_per_jiffy
= new_tb_ticks_per_jiffy
;
285 tb_ticks_per_sec
= new_tb_ticks_per_sec
;
286 div128_by_32( XSEC_PER_SEC
, 0, tb_ticks_per_sec
, &divres
);
287 do_gtod
.tb_ticks_per_sec
= tb_ticks_per_sec
;
288 tb_to_xs
= divres
.result_low
;
289 do_gtod
.varp
->tb_to_xs
= tb_to_xs
;
290 systemcfg
->tb_ticks_per_sec
= tb_ticks_per_sec
;
291 systemcfg
->tb_to_xs
= tb_to_xs
;
294 printk( "Titan recalibrate: FAILED (difference > 4 percent)\n"
295 " new tb_ticks_per_jiffy = %lu\n"
296 " old tb_ticks_per_jiffy = %lu\n",
297 new_tb_ticks_per_jiffy
, tb_ticks_per_jiffy
);
301 iSeries_recal_titan
= titan
;
302 iSeries_recal_tb
= tb
;
307 * For iSeries shared processors, we have to let the hypervisor
308 * set the hardware decrementer. We set a virtual decrementer
309 * in the lppaca and call the hypervisor if the virtual
310 * decrementer is less than the current value in the hardware
311 * decrementer. (almost always the new decrementer value will
312 * be greater than the current hardware decementer so the hypervisor
313 * call will not be needed)
316 unsigned long tb_last_stamp __cacheline_aligned_in_smp
;
319 * timer_interrupt - gets called when the decrementer overflows,
320 * with interrupts disabled.
322 int timer_interrupt(struct pt_regs
* regs
)
325 unsigned long cur_tb
;
326 struct paca_struct
*lpaca
= get_paca();
327 unsigned long cpu
= smp_processor_id();
331 profile_tick(CPU_PROFILING
, regs
);
333 lpaca
->lppaca
.int_dword
.fields
.decr_int
= 0;
335 while (lpaca
->next_jiffy_update_tb
<= (cur_tb
= get_tb())) {
337 * We cannot disable the decrementer, so in the period
338 * between this cpu's being marked offline in cpu_online_map
339 * and calling stop-self, it is taking timer interrupts.
340 * Avoid calling into the scheduler rebalancing code if this
343 if (!cpu_is_offline(cpu
))
344 update_process_times(user_mode(regs
));
346 * No need to check whether cpu is offline here; boot_cpuid
347 * should have been fixed up by now.
349 if (cpu
== boot_cpuid
) {
350 write_seqlock(&xtime_lock
);
351 tb_last_stamp
= lpaca
->next_jiffy_update_tb
;
352 timer_recalc_offset(lpaca
->next_jiffy_update_tb
);
354 timer_sync_xtime(lpaca
->next_jiffy_update_tb
);
356 write_sequnlock(&xtime_lock
);
357 if ( adjusting_time
&& (time_adjust
== 0) )
360 lpaca
->next_jiffy_update_tb
+= tb_ticks_per_jiffy
;
363 next_dec
= lpaca
->next_jiffy_update_tb
- cur_tb
;
364 if (next_dec
> lpaca
->default_decr
)
365 next_dec
= lpaca
->default_decr
;
368 #ifdef CONFIG_PPC_ISERIES
369 if (hvlpevent_is_pending())
370 process_hvlpevents(regs
);
373 /* collect purr register values often, for accurate calculations */
374 if (firmware_has_feature(FW_FEATURE_SPLPAR
)) {
375 struct cpu_usage
*cu
= &__get_cpu_var(cpu_usage_array
);
376 cu
->current_tb
= mfspr(SPRN_PURR
);
385 * Scheduler clock - returns current time in nanosec units.
387 * Note: mulhdu(a, b) (multiply high double unsigned) returns
388 * the high 64 bits of a * b, i.e. (a * b) >> 64, where a and b
389 * are 64-bit unsigned numbers.
391 unsigned long long sched_clock(void)
393 return mulhdu(get_tb(), tb_to_ns_scale
) << tb_to_ns_shift
;
396 int do_settimeofday(struct timespec
*tv
)
398 time_t wtm_sec
, new_sec
= tv
->tv_sec
;
399 long wtm_nsec
, new_nsec
= tv
->tv_nsec
;
401 unsigned long delta_xsec
;
403 unsigned long new_xsec
;
405 if ((unsigned long)tv
->tv_nsec
>= NSEC_PER_SEC
)
408 write_seqlock_irqsave(&xtime_lock
, flags
);
409 /* Updating the RTC is not the job of this code. If the time is
410 * stepped under NTP, the RTC will be update after STA_UNSYNC
411 * is cleared. Tool like clock/hwclock either copy the RTC
412 * to the system time, in which case there is no point in writing
413 * to the RTC again, or write to the RTC but then they don't call
414 * settimeofday to perform this operation.
416 #ifdef CONFIG_PPC_ISERIES
417 if ( first_settimeofday
) {
419 first_settimeofday
= 0;
422 tb_delta
= tb_ticks_since(tb_last_stamp
);
423 tb_delta
+= (jiffies
- wall_jiffies
) * tb_ticks_per_jiffy
;
425 new_nsec
-= tb_delta
/ tb_ticks_per_usec
/ 1000;
427 wtm_sec
= wall_to_monotonic
.tv_sec
+ (xtime
.tv_sec
- new_sec
);
428 wtm_nsec
= wall_to_monotonic
.tv_nsec
+ (xtime
.tv_nsec
- new_nsec
);
430 set_normalized_timespec(&xtime
, new_sec
, new_nsec
);
431 set_normalized_timespec(&wall_to_monotonic
, wtm_sec
, wtm_nsec
);
433 /* In case of a large backwards jump in time with NTP, we want the
434 * clock to be updated as soon as the PLL is again in lock.
436 last_rtc_update
= new_sec
- 658;
440 delta_xsec
= mulhdu( (tb_last_stamp
-do_gtod
.varp
->tb_orig_stamp
),
441 do_gtod
.varp
->tb_to_xs
);
443 new_xsec
= (new_nsec
* XSEC_PER_SEC
) / NSEC_PER_SEC
;
444 new_xsec
+= new_sec
* XSEC_PER_SEC
;
445 if ( new_xsec
> delta_xsec
) {
446 do_gtod
.varp
->stamp_xsec
= new_xsec
- delta_xsec
;
447 systemcfg
->stamp_xsec
= new_xsec
- delta_xsec
;
450 /* This is only for the case where the user is setting the time
451 * way back to a time such that the boot time would have been
452 * before 1970 ... eg. we booted ten days ago, and we are setting
453 * the time to Jan 5, 1970 */
454 do_gtod
.varp
->stamp_xsec
= new_xsec
;
455 do_gtod
.varp
->tb_orig_stamp
= tb_last_stamp
;
456 systemcfg
->stamp_xsec
= new_xsec
;
457 systemcfg
->tb_orig_stamp
= tb_last_stamp
;
460 systemcfg
->tz_minuteswest
= sys_tz
.tz_minuteswest
;
461 systemcfg
->tz_dsttime
= sys_tz
.tz_dsttime
;
463 write_sequnlock_irqrestore(&xtime_lock
, flags
);
468 EXPORT_SYMBOL(do_settimeofday
);
470 #if defined(CONFIG_PPC_PSERIES) || defined(CONFIG_PPC_MAPLE) || defined(CONFIG_PPC_BPA)
471 void __init
generic_calibrate_decr(void)
473 struct device_node
*cpu
;
474 struct div_result divres
;
479 * The cpu node should have a timebase-frequency property
480 * to tell us the rate at which the decrementer counts.
482 cpu
= of_find_node_by_type(NULL
, "cpu");
484 ppc_tb_freq
= DEFAULT_TB_FREQ
; /* hardcoded default */
487 fp
= (unsigned int *)get_property(cpu
, "timebase-frequency",
495 printk(KERN_ERR
"WARNING: Estimating decrementer frequency "
498 ppc_proc_freq
= DEFAULT_PROC_FREQ
;
501 fp
= (unsigned int *)get_property(cpu
, "clock-frequency",
509 printk(KERN_ERR
"WARNING: Estimating processor frequency "
514 printk(KERN_INFO
"time_init: decrementer frequency = %lu.%.6lu MHz\n",
515 ppc_tb_freq
/1000000, ppc_tb_freq
%1000000);
516 printk(KERN_INFO
"time_init: processor frequency = %lu.%.6lu MHz\n",
517 ppc_proc_freq
/1000000, ppc_proc_freq
%1000000);
519 tb_ticks_per_jiffy
= ppc_tb_freq
/ HZ
;
520 tb_ticks_per_sec
= tb_ticks_per_jiffy
* HZ
;
521 tb_ticks_per_usec
= ppc_tb_freq
/ 1000000;
522 tb_to_us
= mulhwu_scale_factor(ppc_tb_freq
, 1000000);
523 div128_by_32(1024*1024, 0, tb_ticks_per_sec
, &divres
);
524 tb_to_xs
= divres
.result_low
;
526 setup_default_decr();
530 void __init
time_init(void)
532 /* This function is only called on the boot processor */
535 struct div_result res
;
536 unsigned long scale
, shift
;
538 ppc_md
.calibrate_decr();
541 * Compute scale factor for sched_clock.
542 * The calibrate_decr() function has set tb_ticks_per_sec,
543 * which is the timebase frequency.
544 * We compute 1e9 * 2^64 / tb_ticks_per_sec and interpret
545 * the 128-bit result as a 64.64 fixed-point number.
546 * We then shift that number right until it is less than 1.0,
547 * giving us the scale factor and shift count to use in
550 div128_by_32(1000000000, 0, tb_ticks_per_sec
, &res
);
551 scale
= res
.result_low
;
552 for (shift
= 0; res
.result_high
!= 0; ++shift
) {
553 scale
= (scale
>> 1) | (res
.result_high
<< 63);
554 res
.result_high
>>= 1;
556 tb_to_ns_scale
= scale
;
557 tb_to_ns_shift
= shift
;
559 #ifdef CONFIG_PPC_ISERIES
560 if (!piranha_simulator
)
562 ppc_md
.get_boot_time(&tm
);
564 write_seqlock_irqsave(&xtime_lock
, flags
);
565 xtime
.tv_sec
= mktime(tm
.tm_year
+ 1900, tm
.tm_mon
+ 1, tm
.tm_mday
,
566 tm
.tm_hour
, tm
.tm_min
, tm
.tm_sec
);
567 tb_last_stamp
= get_tb();
568 do_gtod
.varp
= &do_gtod
.vars
[0];
570 do_gtod
.varp
->tb_orig_stamp
= tb_last_stamp
;
571 get_paca()->next_jiffy_update_tb
= tb_last_stamp
+ tb_ticks_per_jiffy
;
572 do_gtod
.varp
->stamp_xsec
= xtime
.tv_sec
* XSEC_PER_SEC
;
573 do_gtod
.tb_ticks_per_sec
= tb_ticks_per_sec
;
574 do_gtod
.varp
->tb_to_xs
= tb_to_xs
;
575 do_gtod
.tb_to_us
= tb_to_us
;
576 systemcfg
->tb_orig_stamp
= tb_last_stamp
;
577 systemcfg
->tb_update_count
= 0;
578 systemcfg
->tb_ticks_per_sec
= tb_ticks_per_sec
;
579 systemcfg
->stamp_xsec
= xtime
.tv_sec
* XSEC_PER_SEC
;
580 systemcfg
->tb_to_xs
= tb_to_xs
;
585 last_rtc_update
= xtime
.tv_sec
;
586 set_normalized_timespec(&wall_to_monotonic
,
587 -xtime
.tv_sec
, -xtime
.tv_nsec
);
588 write_sequnlock_irqrestore(&xtime_lock
, flags
);
590 /* Not exact, but the timer interrupt takes care of this */
591 set_dec(tb_ticks_per_jiffy
);
595 * After adjtimex is called, adjust the conversion of tb ticks
596 * to microseconds to keep do_gettimeofday synchronized
599 * Use the time_adjust, time_freq and time_offset computed by adjtimex to
600 * adjust the frequency.
603 /* #define DEBUG_PPC_ADJTIMEX 1 */
605 void ppc_adjtimex(void)
607 unsigned long den
, new_tb_ticks_per_sec
, tb_ticks
, old_xsec
, new_tb_to_xs
, new_xsec
, new_stamp_xsec
;
608 unsigned long tb_ticks_per_sec_delta
;
609 long delta_freq
, ltemp
;
610 struct div_result divres
;
612 struct gettimeofday_vars
* temp_varp
;
614 long singleshot_ppm
= 0;
616 /* Compute parts per million frequency adjustment to accomplish the time adjustment
617 implied by time_offset to be applied over the elapsed time indicated by time_constant.
618 Use SHIFT_USEC to get it into the same units as time_freq. */
619 if ( time_offset
< 0 ) {
620 ltemp
= -time_offset
;
621 ltemp
<<= SHIFT_USEC
- SHIFT_UPDATE
;
622 ltemp
>>= SHIFT_KG
+ time_constant
;
627 ltemp
<<= SHIFT_USEC
- SHIFT_UPDATE
;
628 ltemp
>>= SHIFT_KG
+ time_constant
;
631 /* If there is a single shot time adjustment in progress */
633 #ifdef DEBUG_PPC_ADJTIMEX
634 printk("ppc_adjtimex: ");
635 if ( adjusting_time
== 0 )
637 printk("single shot time_adjust = %ld\n", time_adjust
);
642 /* Compute parts per million frequency adjustment to match time_adjust */
643 singleshot_ppm
= tickadj
* HZ
;
645 * The adjustment should be tickadj*HZ to match the code in
646 * linux/kernel/timer.c, but experiments show that this is too
647 * large. 3/4 of tickadj*HZ seems about right
649 singleshot_ppm
-= singleshot_ppm
/ 4;
650 /* Use SHIFT_USEC to get it into the same units as time_freq */
651 singleshot_ppm
<<= SHIFT_USEC
;
652 if ( time_adjust
< 0 )
653 singleshot_ppm
= -singleshot_ppm
;
656 #ifdef DEBUG_PPC_ADJTIMEX
657 if ( adjusting_time
)
658 printk("ppc_adjtimex: ending single shot time_adjust\n");
663 /* Add up all of the frequency adjustments */
664 delta_freq
= time_freq
+ ltemp
+ singleshot_ppm
;
666 /* Compute a new value for tb_ticks_per_sec based on the frequency adjustment */
667 den
= 1000000 * (1 << (SHIFT_USEC
- 8));
668 if ( delta_freq
< 0 ) {
669 tb_ticks_per_sec_delta
= ( tb_ticks_per_sec
* ( (-delta_freq
) >> (SHIFT_USEC
- 8))) / den
;
670 new_tb_ticks_per_sec
= tb_ticks_per_sec
+ tb_ticks_per_sec_delta
;
673 tb_ticks_per_sec_delta
= ( tb_ticks_per_sec
* ( delta_freq
>> (SHIFT_USEC
- 8))) / den
;
674 new_tb_ticks_per_sec
= tb_ticks_per_sec
- tb_ticks_per_sec_delta
;
677 #ifdef DEBUG_PPC_ADJTIMEX
678 printk("ppc_adjtimex: ltemp = %ld, time_freq = %ld, singleshot_ppm = %ld\n", ltemp
, time_freq
, singleshot_ppm
);
679 printk("ppc_adjtimex: tb_ticks_per_sec - base = %ld new = %ld\n", tb_ticks_per_sec
, new_tb_ticks_per_sec
);
682 /* Compute a new value of tb_to_xs (used to convert tb to microseconds and a new value of
683 stamp_xsec which is the time (in 1/2^20 second units) corresponding to tb_orig_stamp. This
684 new value of stamp_xsec compensates for the change in frequency (implied by the new tb_to_xs)
685 which guarantees that the current time remains the same */
686 write_seqlock_irqsave( &xtime_lock
, flags
);
687 tb_ticks
= get_tb() - do_gtod
.varp
->tb_orig_stamp
;
688 div128_by_32( 1024*1024, 0, new_tb_ticks_per_sec
, &divres
);
689 new_tb_to_xs
= divres
.result_low
;
690 new_xsec
= mulhdu( tb_ticks
, new_tb_to_xs
);
692 old_xsec
= mulhdu( tb_ticks
, do_gtod
.varp
->tb_to_xs
);
693 new_stamp_xsec
= do_gtod
.varp
->stamp_xsec
+ old_xsec
- new_xsec
;
695 /* There are two copies of tb_to_xs and stamp_xsec so that no lock is needed to access and use these
696 values in do_gettimeofday. We alternate the copies and as long as a reasonable time elapses between
697 changes, there will never be inconsistent values. ntpd has a minimum of one minute between updates */
699 temp_idx
= (do_gtod
.var_idx
== 0);
700 temp_varp
= &do_gtod
.vars
[temp_idx
];
702 temp_varp
->tb_to_xs
= new_tb_to_xs
;
703 temp_varp
->stamp_xsec
= new_stamp_xsec
;
704 temp_varp
->tb_orig_stamp
= do_gtod
.varp
->tb_orig_stamp
;
706 do_gtod
.varp
= temp_varp
;
707 do_gtod
.var_idx
= temp_idx
;
710 * tb_update_count is used to allow the problem state gettimeofday code
711 * to assure itself that it sees a consistent view of the tb_to_xs and
712 * stamp_xsec variables. It reads the tb_update_count, then reads
713 * tb_to_xs and stamp_xsec and then reads tb_update_count again. If
714 * the two values of tb_update_count match and are even then the
715 * tb_to_xs and stamp_xsec values are consistent. If not, then it
716 * loops back and reads them again until this criteria is met.
718 ++(systemcfg
->tb_update_count
);
720 systemcfg
->tb_to_xs
= new_tb_to_xs
;
721 systemcfg
->stamp_xsec
= new_stamp_xsec
;
723 ++(systemcfg
->tb_update_count
);
725 write_sequnlock_irqrestore( &xtime_lock
, flags
);
730 #define TICK_SIZE tick
732 #define STARTOFTIME 1970
733 #define SECDAY 86400L
734 #define SECYR (SECDAY * 365)
735 #define leapyear(year) ((year) % 4 == 0)
736 #define days_in_year(a) (leapyear(a) ? 366 : 365)
737 #define days_in_month(a) (month_days[(a) - 1])
739 static int month_days
[12] = {
740 31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31
744 * This only works for the Gregorian calendar - i.e. after 1752 (in the UK)
746 void GregorianDay(struct rtc_time
* tm
)
751 int MonthOffset
[] = { 0, 31, 59, 90, 120, 151, 181, 212, 243, 273, 304, 334 };
753 lastYear
=tm
->tm_year
-1;
756 * Number of leap corrections to apply up to end of last year
758 leapsToDate
= lastYear
/4 - lastYear
/100 + lastYear
/400;
761 * This year is a leap year if it is divisible by 4 except when it is
762 * divisible by 100 unless it is divisible by 400
764 * e.g. 1904 was a leap year, 1900 was not, 1996 is, and 2000 will be
766 if((tm
->tm_year
%4==0) &&
767 ((tm
->tm_year
%100!=0) || (tm
->tm_year
%400==0)) &&
771 * We are past Feb. 29 in a leap year
780 day
+= lastYear
*365 + leapsToDate
+ MonthOffset
[tm
->tm_mon
-1] +
786 void to_tm(int tim
, struct rtc_time
* tm
)
789 register long hms
, day
;
794 /* Hours, minutes, seconds are easy */
795 tm
->tm_hour
= hms
/ 3600;
796 tm
->tm_min
= (hms
% 3600) / 60;
797 tm
->tm_sec
= (hms
% 3600) % 60;
799 /* Number of years in days */
800 for (i
= STARTOFTIME
; day
>= days_in_year(i
); i
++)
801 day
-= days_in_year(i
);
804 /* Number of months in days left */
805 if (leapyear(tm
->tm_year
))
806 days_in_month(FEBRUARY
) = 29;
807 for (i
= 1; day
>= days_in_month(i
); i
++)
808 day
-= days_in_month(i
);
809 days_in_month(FEBRUARY
) = 28;
812 /* Days are what is left over (+1) from all that. */
813 tm
->tm_mday
= day
+ 1;
816 * Determine the day of week
821 /* Auxiliary function to compute scaling factors */
822 /* Actually the choice of a timebase running at 1/4 the of the bus
823 * frequency giving resolution of a few tens of nanoseconds is quite nice.
824 * It makes this computation very precise (27-28 bits typically) which
825 * is optimistic considering the stability of most processor clock
826 * oscillators and the precision with which the timebase frequency
827 * is measured but does not harm.
829 unsigned mulhwu_scale_factor(unsigned inscale
, unsigned outscale
) {
830 unsigned mlt
=0, tmp
, err
;
831 /* No concern for performance, it's done once: use a stupid
832 * but safe and compact method to find the multiplier.
835 for (tmp
= 1U<<31; tmp
!= 0; tmp
>>= 1) {
836 if (mulhwu(inscale
, mlt
|tmp
) < outscale
) mlt
|=tmp
;
839 /* We might still be off by 1 for the best approximation.
840 * A side effect of this is that if outscale is too large
841 * the returned value will be zero.
842 * Many corner cases have been checked and seem to work,
843 * some might have been forgotten in the test however.
846 err
= inscale
*(mlt
+1);
847 if (err
<= inscale
/2) mlt
++;
852 * Divide a 128-bit dividend by a 32-bit divisor, leaving a 128 bit
856 void div128_by_32( unsigned long dividend_high
, unsigned long dividend_low
,
857 unsigned divisor
, struct div_result
*dr
)
859 unsigned long a
,b
,c
,d
, w
,x
,y
,z
, ra
,rb
,rc
;
861 a
= dividend_high
>> 32;
862 b
= dividend_high
& 0xffffffff;
863 c
= dividend_low
>> 32;
864 d
= dividend_low
& 0xffffffff;
867 ra
= (a
- (w
* divisor
)) << 32;
869 x
= (ra
+ b
)/divisor
;
870 rb
= ((ra
+ b
) - (x
* divisor
)) << 32;
872 y
= (rb
+ c
)/divisor
;
873 rc
= ((rb
+ b
) - (y
* divisor
)) << 32;
875 z
= (rc
+ d
)/divisor
;
877 dr
->result_high
= (w
<< 32) + x
;
878 dr
->result_low
= (y
<< 32) + z
;