1 /*        $NetBSD: ntp_calendar.c,v 1.12 2024/08/18 20:47:13 christos Exp $     */
2 
3 /*
4  * ntp_calendar.c - calendar and helper functions
5  *
6  * Written by Juergen Perlinger (perlinger@ntp.org) for the NTP project.
7  * The contents of 'html/copyright.html' apply.
8  *
9  * --------------------------------------------------------------------
10  * Some notes on the implementation:
11  *
12  * Calendar algorithms thrive on the division operation, which is one of
13  * the slowest numerical operations in any CPU. What saves us here from
14  * abysmal performance is the fact that all divisions are divisions by
15  * constant numbers, and most compilers can do this by a multiplication
16  * operation.  But this might not work when using the div/ldiv/lldiv
17  * function family, because many compilers are not able to do inline
18  * expansion of the code with following optimisation for the
19  * constant-divider case.
20  *
21  * Also div/ldiv/lldiv are defined in terms of int/long/longlong, which
22  * are inherently target dependent. Nothing that could not be cured with
23  * autoconf, but still a mess...
24  *
25  * Furthermore, we need floor division in many places. C either leaves
26  * the division behaviour undefined (< C99) or demands truncation to
27  * zero (>= C99), so additional steps are required to make sure the
28  * algorithms work. The {l,ll}div function family is requested to
29  * truncate towards zero, which is also the wrong direction for our
30  * purpose.
31  *
32  * For all this, all divisions by constant are coded manually, even when
33  * there is a joined div/mod operation: The optimiser should sort that
34  * out, if possible. Most of the calculations are done with unsigned
35  * types, explicitely using two's complement arithmetics where
36  * necessary. This minimises the dependecies to compiler and target,
37  * while still giving reasonable to good performance.
38  *
39  * The implementation uses a few tricks that exploit properties of the
40  * two's complement: Floor division on negative dividents can be
41  * executed by using the one's complement of the divident. One's
42  * complement can be easily created using XOR and a mask.
43  *
44  * Finally, check for overflow conditions is minimal. There are only two
45  * calculation steps in the whole calendar that potentially suffer from
46  * an internal overflow, and these are coded in a way that avoids
47  * it. All other functions do not suffer from internal overflow and
48  * simply return the result truncated to 32 bits.
49  */
50 
51 #include <config.h>
52 #include <sys/types.h>
53 
54 #include "ntp_types.h"
55 #include "ntp_calendar.h"
56 #include "ntp_stdlib.h"
57 #include "ntp_fp.h"
58 #include "ntp_unixtime.h"
59 
60 #include "ntpd.h"
61 
62 /* For now, let's take the conservative approach: if the target property
63  * macros are not defined, check a few well-known compiler/architecture
64  * settings. Default is to assume that the representation of signed
65  * integers is unknown and shift-arithmetic-right is not available.
66  */
67 #ifndef TARGET_HAS_2CPL
68 # if defined(__GNUC__)
69 #  if defined(__i386__) || defined(__x86_64__) || defined(__arm__)
70 #   define TARGET_HAS_2CPL 1
71 #  else
72 #   define TARGET_HAS_2CPL 0
73 #  endif
74 # elif defined(_MSC_VER)
75 #  if defined(_M_IX86) || defined(_M_X64) || defined(_M_ARM)
76 #   define TARGET_HAS_2CPL 1
77 #  else
78 #   define TARGET_HAS_2CPL 0
79 #  endif
80 # else
81 #  define TARGET_HAS_2CPL 0
82 # endif
83 #endif
84 
85 #ifndef TARGET_HAS_SAR
86 # define TARGET_HAS_SAR 0
87 #endif
88 
89 #if !defined(HAVE_64BITREGS) && defined(UINT64_MAX) && (SIZE_MAX >= UINT64_MAX)
90 # define HAVE_64BITREGS
91 #endif
92 
93 /*
94  *---------------------------------------------------------------------
95  * replacing the 'time()' function
96  *---------------------------------------------------------------------
97  */
98 
99 static systime_func_ptr systime_func = &time;
100 static inline time_t now(void);
101 
102 
103 systime_func_ptr
ntpcal_set_timefunc(systime_func_ptr nfunc)104 ntpcal_set_timefunc(
105           systime_func_ptr nfunc
106           )
107 {
108           systime_func_ptr res;
109 
110           res = systime_func;
111           if (NULL == nfunc)
112                     nfunc = &time;
113           systime_func = nfunc;
114 
115           return res;
116 }
117 
118 
119 static inline time_t
now(void)120 now(void)
121 {
122           return (*systime_func)(NULL);
123 }
124 
125 /*
126  *---------------------------------------------------------------------
127  * Get sign extension mask and unsigned 2cpl rep for a signed integer
128  *---------------------------------------------------------------------
129  */
130 
131 static inline uint32_t
int32_sflag(const int32_t v)132 int32_sflag(
133           const int32_t v)
134 {
135 #   if TARGET_HAS_2CPL && TARGET_HAS_SAR && SIZEOF_INT >= 4
136 
137           /* Let's assume that shift is the fastest way to get the sign
138            * extension of of a signed integer. This might not always be
139            * true, though -- On 8bit CPUs or machines without barrel
140            * shifter this will kill the performance. So we make sure
141            * we do this only if 'int' has at least 4 bytes.
142            */
143           return (uint32_t)(v >> 31);
144 
145 #   else
146 
147           /* This should be a rather generic approach for getting a sign
148            * extension mask...
149            */
150           return UINT32_C(0) - (uint32_t)(v < 0);
151 
152 #   endif
153 }
154 
155 static inline int32_t
uint32_2cpl_to_int32(const uint32_t vu)156 uint32_2cpl_to_int32(
157           const uint32_t vu)
158 {
159           int32_t v;
160 
161 #   if TARGET_HAS_2CPL
162 
163           /* Just copy through the 32 bits from the unsigned value if
164            * we're on a two's complement target.
165            */
166           v = (int32_t)vu;
167 
168 #   else
169 
170           /* Convert to signed integer, making sure signed integer
171            * overflow cannot happen. Again, the optimiser might or might
172            * not find out that this is just a copy of 32 bits on a target
173            * with two's complement representation for signed integers.
174            */
175           if (vu > INT32_MAX)
176                     v = -(int32_t)(~vu) - 1;
177           else
178                     v = (int32_t)vu;
179 
180 #   endif
181 
182           return v;
183 }
184 
185 /*
186  *---------------------------------------------------------------------
187  * Convert between 'time_t' and 'vint64'
188  *---------------------------------------------------------------------
189  */
190 vint64
time_to_vint64(const time_t * ptt)191 time_to_vint64(
192           const time_t * ptt
193           )
194 {
195           vint64 res;
196           time_t tt;
197 
198           tt = *ptt;
199 
200 #   if SIZEOF_TIME_T <= 4
201 
202           res.D_s.hi = 0;
203           if (tt < 0) {
204                     res.D_s.lo = (uint32_t)-tt;
205                     M_NEG(res.D_s.hi, res.D_s.lo);
206           } else {
207                     res.D_s.lo = (uint32_t)tt;
208           }
209 
210 #   elif defined(HAVE_INT64)
211 
212           res.q_s = tt;
213 
214 #   else
215           /*
216            * shifting negative signed quantities is compiler-dependent, so
217            * we better avoid it and do it all manually. And shifting more
218            * than the width of a quantity is undefined. Also a don't do!
219            */
220           if (tt < 0) {
221                     tt = -tt;
222                     res.D_s.lo = (uint32_t)tt;
223                     res.D_s.hi = (uint32_t)(tt >> 32);
224                     M_NEG(res.D_s.hi, res.D_s.lo);
225           } else {
226                     res.D_s.lo = (uint32_t)tt;
227                     res.D_s.hi = (uint32_t)(tt >> 32);
228           }
229 
230 #   endif
231 
232           return res;
233 }
234 
235 
236 time_t
vint64_to_time(const vint64 * tv)237 vint64_to_time(
238           const vint64 *tv
239           )
240 {
241           time_t res;
242 
243 #   if SIZEOF_TIME_T <= 4
244 
245           res = (time_t)tv->D_s.lo;
246 
247 #   elif defined(HAVE_INT64)
248 
249           res = (time_t)tv->q_s;
250 
251 #   else
252 
253           res = ((time_t)tv->d_s.hi << 32) | tv->D_s.lo;
254 
255 #   endif
256 
257           return res;
258 }
259 
260 /*
261  *---------------------------------------------------------------------
262  * Get the build date & time
263  *---------------------------------------------------------------------
264  */
265 int
ntpcal_get_build_date(struct calendar * jd)266 ntpcal_get_build_date(
267           struct calendar * jd
268           )
269 {
270           /* The C standard tells us the format of '__DATE__':
271            *
272            * __DATE__ The date of translation of the preprocessing
273            * translation unit: a character string literal of the form "Mmm
274            * dd yyyy", where the names of the months are the same as those
275            * generated by the asctime function, and the first character of
276            * dd is a space character if the value is less than 10. If the
277            * date of translation is not available, an
278            * implementation-defined valid date shall be supplied.
279            *
280            * __TIME__ The time of translation of the preprocessing
281            * translation unit: a character string literal of the form
282            * "hh:mm:ss" as in the time generated by the asctime
283            * function. If the time of translation is not available, an
284            * implementation-defined valid time shall be supplied.
285            *
286            * Note that MSVC declares DATE and TIME to be in the local time
287            * zone, while neither the C standard nor the GCC docs make any
288            * statement about this. As a result, we may be +/-12hrs off
289            * UTC.    But for practical purposes, this should not be a
290            * problem.
291            *
292            */
293 #   ifdef MKREPRO_DATE
294           static const char build[] = MKREPRO_TIME "/" MKREPRO_DATE;
295 #   else
296           static const char build[] = __TIME__ "/" __DATE__;
297 #   endif
298           static const char mlist[] = "JanFebMarAprMayJunJulAugSepOctNovDec";
299 
300           char                  monstr[4];
301           const char *          cp;
302           unsigned short        hour, minute, second, day, year;
303           /* Note: The above quantities are used for sscanf 'hu' format,
304            * so using 'uint16_t' is contra-indicated!
305            */
306 
307 #   ifdef DEBUG
308           static int            ignore  = 0;
309 #   endif
310 
311           ZERO(*jd);
312           jd->year     = 1970;
313           jd->month    = 1;
314           jd->monthday = 1;
315 
316 #   ifdef DEBUG
317           /* check environment if build date should be ignored */
318           if (0 == ignore) {
319               const char * envstr;
320               envstr = getenv("NTPD_IGNORE_BUILD_DATE");
321               ignore = 1 + (envstr && (!*envstr || !strcasecmp(envstr, "yes")));
322           }
323           if (ignore > 1)
324               return FALSE;
325 #   endif
326 
327           if (6 == sscanf(build, "%hu:%hu:%hu/%3s %hu %hu",
328                               &hour, &minute, &second, monstr, &day, &year)) {
329                     cp = strstr(mlist, monstr);
330                     if (NULL != cp) {
331                               jd->year     = year;
332                               jd->month    = (uint8_t)((cp - mlist) / 3 + 1);
333                               jd->monthday = (uint8_t)day;
334                               jd->hour     = (uint8_t)hour;
335                               jd->minute   = (uint8_t)minute;
336                               jd->second   = (uint8_t)second;
337 
338                               return TRUE;
339                     }
340           }
341 
342           return FALSE;
343 }
344 
345 
346 /*
347  *---------------------------------------------------------------------
348  * basic calendar stuff
349  *---------------------------------------------------------------------
350  */
351 
352 /*
353  * Some notes on the terminology:
354  *
355  * We use the proleptic Gregorian calendar, which is the Gregorian
356  * calendar extended in both directions ad infinitum. This totally
357  * disregards the fact that this calendar was invented in 1582, and
358  * was adopted at various dates over the world; sometimes even after
359  * the start of the NTP epoch.
360  *
361  * Normally date parts are given as current cycles, while time parts
362  * are given as elapsed cycles:
363  *
364  * 1970-01-01/03:04:05 means 'IN the 1970st. year, IN the first month,
365  * ON the first day, with 3hrs, 4minutes and 5 seconds elapsed.
366  *
367  * The basic calculations for this calendar implementation deal with
368  * ELAPSED date units, which is the number of full years, full months
369  * and full days before a date: 1970-01-01 would be (1969, 0, 0) in
370  * that notation.
371  *
372  * To ease the numeric computations, month and day values outside the
373  * normal range are acceptable: 2001-03-00 will be treated as the day
374  * before 2001-03-01, 2000-13-32 will give the same result as
375  * 2001-02-01 and so on.
376  *
377  * 'rd' or 'RD' is used as an abbreviation for the latin 'rata die'
378  * (day number).  This is the number of days elapsed since 0000-12-31
379  * in the proleptic Gregorian calendar. The begin of the Christian Era
380  * (0001-01-01) is RD(1).
381  */
382 
383 /*
384  * ====================================================================
385  *
386  * General algorithmic stuff
387  *
388  * ====================================================================
389  */
390 
391 /*
392  *---------------------------------------------------------------------
393  * fast modulo 7 operations (floor/mathematical convention)
394  *---------------------------------------------------------------------
395  */
396 int
u32mod7(uint32_t x)397 u32mod7(
398           uint32_t x
399           )
400 {
401           /* This is a combination of tricks from "Hacker's Delight" with
402            * some modifications, like a multiplication that rounds up to
403            * drop the final adjustment stage.
404            *
405            * Do a partial reduction by digit sum to keep the value in the
406            * range permitted for the mul/shift stage. There are several
407            * possible and absolutely equivalent shift/mask combinations;
408            * this one is ARM-friendly because of a mask that fits into 16
409            * bit.
410            */
411           x = (x >> 15) + (x & UINT32_C(0x7FFF));
412           /* Take reminder as (mod 8) by mul/shift. Since the multiplier
413            * was calculated using ceil() instead of floor(), it skips the
414            * value '7' properly.
415            *    M <- ceil(ldexp(8/7, 29))
416            */
417           return (int)((x * UINT32_C(0x24924925)) >> 29);
418 }
419 
420 int
i32mod7(int32_t x)421 i32mod7(
422           int32_t x
423           )
424 {
425           /* We add (2**32 - 2**32 % 7), which is (2**32 - 4), to negative
426            * numbers to map them into the postive range. Only the term '-4'
427            * survives, obviously.
428            */
429           uint32_t ux = (uint32_t)x;
430           return u32mod7((x < 0) ? (ux - 4u) : ux);
431 }
432 
433 uint32_t
i32fmod(int32_t x,uint32_t d)434 i32fmod(
435           int32_t    x,
436           uint32_t d
437           )
438 {
439           uint32_t ux = (uint32_t)x;
440           uint32_t sf = UINT32_C(0) - (x < 0);
441           ux = (sf ^ ux ) % d;
442           return (d & sf) + (sf ^ ux);
443 }
444 
445 /*
446  *---------------------------------------------------------------------
447  * Do a periodic extension of 'value' around 'pivot' with a period of
448  * 'cycle'.
449  *
450  * The result 'res' is a number that holds to the following properties:
451  *
452  *   1)    res MOD cycle == value MOD cycle
453  *   2)    pivot <= res < pivot + cycle
454  *         (replace </<= with >/>= for negative cycles)
455  *
456  * where 'MOD' denotes the modulo operator for FLOOR DIVISION, which
457  * is not the same as the '%' operator in C: C requires division to be
458  * a truncated division, where remainder and dividend have the same
459  * sign if the remainder is not zero, whereas floor division requires
460  * divider and modulus to have the same sign for a non-zero modulus.
461  *
462  * This function has some useful applications:
463  *
464  * + let Y be a calendar year and V a truncated 2-digit year: then
465  *        periodic_extend(Y-50, V, 100)
466  *   is the closest expansion of the truncated year with respect to
467  *   the full year, that is a 4-digit year with a difference of less
468  *   than 50 years to the year Y. ("century unfolding")
469  *
470  * + let T be a UN*X time stamp and V be seconds-of-day: then
471  *        perodic_extend(T-43200, V, 86400)
472  *   is a time stamp that has the same seconds-of-day as the input
473  *   value, with an absolute difference to T of <= 12hrs.  ("day
474  *   unfolding")
475  *
476  * + Wherever you have a truncated periodic value and a non-truncated
477  *   base value and you want to match them somehow...
478  *
479  * Basically, the function delivers 'pivot + (value - pivot) % cycle',
480  * but the implementation takes some pains to avoid internal signed
481  * integer overflows in the '(value - pivot) % cycle' part and adheres
482  * to the floor division convention.
483  *
484  * If 64bit scalars where available on all intended platforms, writing a
485  * version that uses 64 bit ops would be easy; writing a general
486  * division routine for 64bit ops on a platform that can only do
487  * 32/16bit divisions and is still performant is a bit more
488  * difficult. Since most usecases can be coded in a way that does only
489  * require the 32bit version a 64bit version is NOT provided here.
490  *---------------------------------------------------------------------
491  */
492 int32_t
ntpcal_periodic_extend(int32_t pivot,int32_t value,int32_t cycle)493 ntpcal_periodic_extend(
494           int32_t pivot,
495           int32_t value,
496           int32_t cycle
497           )
498 {
499           /* Implement a 4-quadrant modulus calculation by 2 2-quadrant
500            * branches, one for positive and one for negative dividers.
501            * Everything else can be handled by bit level logic and
502            * conditional one's complement arithmetic.  By convention, we
503            * assume
504            *
505            * x % b == 0  if  |b| < 2
506            *
507            * that is, we don't actually divide for cycles of -1,0,1 and
508            * return the pivot value in that case.
509            */
510           uint32_t  uv = (uint32_t)value;
511           uint32_t  up = (uint32_t)pivot;
512           uint32_t  uc, sf;
513 
514           if (cycle > 1)
515           {
516                     uc = (uint32_t)cycle;
517                     sf = UINT32_C(0) - (value < pivot);
518 
519                     uv = sf ^ (uv - up);
520                     uv %= uc;
521                     pivot += (uc & sf) + (sf ^ uv);
522           }
523           else if (cycle < -1)
524           {
525                     uc = ~(uint32_t)cycle + 1;
526                     sf = UINT32_C(0) - (value > pivot);
527 
528                     uv = sf ^ (up - uv);
529                     uv %= uc;
530                     pivot -= (uc & sf) + (sf ^ uv);
531           }
532           return pivot;
533 }
534 
535 /*---------------------------------------------------------------------
536  * Note to the casual reader
537  *
538  * In the next two functions you will find (or would have found...)
539  * the expression
540  *
541  *   res.Q_s -= 0x80000000;
542  *
543  * There was some ruckus about a possible programming error due to
544  * integer overflow and sign propagation.
545  *
546  * This assumption is based on a lack of understanding of the C
547  * standard. (Though this is admittedly not one of the most 'natural'
548  * aspects of the 'C' language and easily to get wrong.)
549  *
550  * see
551  *        http://www.open-std.org/jtc1/sc22/wg14/www/docs/n1570.pdf
552  *        "ISO/IEC 9899:201x Committee Draft — April 12, 2011"
553  *        6.4.4.1 Integer constants, clause 5
554  *
555  * why there is no sign extension/overflow problem here.
556  *
557  * But to ease the minds of the doubtful, I added back the 'u' qualifiers
558  * that somehow got lost over the last years.
559  */
560 
561 
562 /*
563  *---------------------------------------------------------------------
564  * Convert a timestamp in NTP scale to a 64bit seconds value in the UN*X
565  * scale with proper epoch unfolding around a given pivot or the current
566  * system time. This function happily accepts negative pivot values as
567  * timestamps before 1970-01-01, so be aware of possible trouble on
568  * platforms with 32bit 'time_t'!
569  *
570  * This is also a periodic extension, but since the cycle is 2^32 and
571  * the shift is 2^31, we can do some *very* fast math without explicit
572  * divisions.
573  *---------------------------------------------------------------------
574  */
575 vint64
ntpcal_ntp_to_time(uint32_t ntp,const time_t * pivot)576 ntpcal_ntp_to_time(
577           uint32_t  ntp,
578           const time_t *      pivot
579           )
580 {
581           vint64 res;
582 
583 #   if defined(HAVE_INT64)
584 
585           res.q_s = (pivot != NULL)
586                           ? *pivot
587                           : now();
588           res.Q_s -= 0x80000000u;                 /* unshift of half range */
589           ntp       -= (uint32_t)JAN_1970;        /* warp into UN*X domain */
590           ntp       -= res.D_s.lo;                /* cycle difference  */
591           res.Q_s += (uint64_t)ntp;     /* get expanded time           */
592 
593 #   else /* no 64bit scalars */
594 
595           time_t tmp;
596 
597           tmp = (pivot != NULL)
598                       ? *pivot
599                       : now();
600           res = time_to_vint64(&tmp);
601           M_SUB(res.D_s.hi, res.D_s.lo, 0, 0x80000000u);
602           ntp -= (uint32_t)JAN_1970;    /* warp into UN*X domain */
603           ntp -= res.D_s.lo;            /* cycle difference  */
604           M_ADD(res.D_s.hi, res.D_s.lo, 0, ntp);
605 
606 #   endif /* no 64bit scalars */
607 
608           return res;
609 }
610 
611 /*
612  *---------------------------------------------------------------------
613  * Convert a timestamp in NTP scale to a 64bit seconds value in the NTP
614  * scale with proper epoch unfolding around a given pivot or the current
615  * system time.
616  *
617  * Note: The pivot must be given in the UN*X time domain!
618  *
619  * This is also a periodic extension, but since the cycle is 2^32 and
620  * the shift is 2^31, we can do some *very* fast math without explicit
621  * divisions.
622  *---------------------------------------------------------------------
623  */
624 vint64
ntpcal_ntp_to_ntp(uint32_t ntp,const time_t * pivot)625 ntpcal_ntp_to_ntp(
626           uint32_t      ntp,
627           const time_t *pivot
628           )
629 {
630           vint64 res;
631 
632 #   if defined(HAVE_INT64)
633 
634           res.q_s = (pivot)
635                           ? *pivot
636                           : now();
637           res.Q_s -= 0x80000000u;                 /* unshift of half range */
638           res.Q_s += (uint32_t)JAN_1970;          /* warp into NTP domain        */
639           ntp       -= res.D_s.lo;                /* cycle difference  */
640           res.Q_s += (uint64_t)ntp;     /* get expanded time           */
641 
642 #   else /* no 64bit scalars */
643 
644           time_t tmp;
645 
646           tmp = (pivot)
647                       ? *pivot
648                       : now();
649           res = time_to_vint64(&tmp);
650           M_SUB(res.D_s.hi, res.D_s.lo, 0, 0x80000000u);
651           M_ADD(res.D_s.hi, res.D_s.lo, 0, (uint32_t)JAN_1970);/*into NTP */
652           ntp -= res.D_s.lo;            /* cycle difference  */
653           M_ADD(res.D_s.hi, res.D_s.lo, 0, ntp);
654 
655 #   endif /* no 64bit scalars */
656 
657           return res;
658 }
659 
660 
661 /*
662  * ====================================================================
663  *
664  * Splitting values to composite entities
665  *
666  * ====================================================================
667  */
668 
669 /*
670  *---------------------------------------------------------------------
671  * Split a 64bit seconds value into elapsed days in 'res.hi' and
672  * elapsed seconds since midnight in 'res.lo' using explicit floor
673  * division. This function happily accepts negative time values as
674  * timestamps before the respective epoch start.
675  *---------------------------------------------------------------------
676  */
677 ntpcal_split
ntpcal_daysplit(const vint64 * ts)678 ntpcal_daysplit(
679           const vint64 *ts
680           )
681 {
682           ntpcal_split res;
683           uint32_t Q, R;
684 
685 #   if defined(HAVE_64BITREGS)
686 
687           /* Assume we have 64bit registers an can do a divison by
688            * constant reasonably fast using the one's complement trick..
689            */
690           uint64_t sf64 = (uint64_t)-(ts->q_s < 0);
691           Q = (uint32_t)(sf64 ^ ((sf64 ^ ts->Q_s) / SECSPERDAY));
692           R = (uint32_t)(ts->Q_s - Q * SECSPERDAY);
693 
694 #   elif defined(UINT64_MAX) && !defined(__arm__)
695 
696           /* We rely on the compiler to do efficient 64bit divisions as
697            * good as possible. Which might or might not be true. At least
698            * for ARM CPUs, the sum-by-digit code in the next section is
699            * faster for many compilers. (This might change over time, but
700            * the 64bit-by-32bit division will never outperform the exact
701            * division by a substantial factor....)
702            */
703           if (ts->q_s < 0)
704                     Q = ~(uint32_t)(~ts->Q_s / SECSPERDAY);
705           else
706                     Q =  (uint32_t)( ts->Q_s / SECSPERDAY);
707           R = ts->D_s.lo - Q * SECSPERDAY;
708 
709 #   else
710 
711           /* We don't have 64bit regs. That hurts a bit.
712            *
713            * Here we use a mean trick to get away with just one explicit
714            * modulo operation and pure 32bit ops.
715            *
716            * Remember: 86400 <--> 128 * 675
717            *
718            * So we discard the lowest 7 bit and do an exact division by
719            * 675, modulo 2**32.
720            *
721            * First we shift out the lower 7 bits.
722            *
723            * Then we use a digit-wise pseudo-reduction, where a 'digit' is
724            * actually a 16-bit group. This is followed by a full reduction
725            * with a 'true' division step. This yields the modulus of the
726            * full 64bit value. The sign bit gets some extra treatment.
727            *
728            * Then we decrement the lower limb by that modulus, so it is
729            * exactly divisible by 675. [*]
730            *
731            * Then we multiply with the modular inverse of 675 (mod 2**32)
732            * and voila, we have the result.
733            *
734            * Special Thanks to Henry S. Warren and his "Hacker's delight"
735            * for giving that idea.
736            *
737            * (Note[*]: that's not the full truth. We would have to
738            * subtract the modulus from the full 64 bit number to get a
739            * number that is divisible by 675. But since we use the
740            * multiplicative inverse (mod 2**32) there's no reason to carry
741            * the subtraction into the upper bits!)
742            */
743           uint32_t al = ts->D_s.lo;
744           uint32_t ah = ts->D_s.hi;
745 
746           /* shift out the lower 7 bits, smash sign bit */
747           al = (al >> 7) | (ah << 25);
748           ah = (ah >> 7) & 0x00FFFFFFu;
749 
750           R  = (ts->d_s.hi < 0) ? 239 : 0;/* sign bit value */
751           R += (al & 0xFFFF);
752           R += (al >> 16       ) * 61u; /* 2**16 % 675 */
753           R += (ah & 0xFFFF) * 346u;    /* 2**32 % 675 */
754           R += (ah >> 16       ) * 181u;          /* 2**48 % 675 */
755           R %= 675u;                              /* final reduction */
756           Q  = (al - R) * 0x2D21C10Bu;  /* modinv(675, 2**32) */
757           R  = (R << 7) | (ts->d_s.lo & 0x07F);
758 
759 #   endif
760 
761           res.hi = uint32_2cpl_to_int32(Q);
762           res.lo = R;
763 
764           return res;
765 }
766 
767 /*
768  *---------------------------------------------------------------------
769  * Split a 64bit seconds value into elapsed weeks in 'res.hi' and
770  * elapsed seconds since week start in 'res.lo' using explicit floor
771  * division. This function happily accepts negative time values as
772  * timestamps before the respective epoch start.
773  *---------------------------------------------------------------------
774  */
775 ntpcal_split
ntpcal_weeksplit(const vint64 * ts)776 ntpcal_weeksplit(
777           const vint64 *ts
778           )
779 {
780           ntpcal_split res;
781           uint32_t Q, R;
782 
783           /* This is a very close relative to the day split function; for
784            * details, see there!
785            */
786 
787 #   if defined(HAVE_64BITREGS)
788 
789           uint64_t sf64 = (uint64_t)-(ts->q_s < 0);
790           Q = (uint32_t)(sf64 ^ ((sf64 ^ ts->Q_s) / SECSPERWEEK));
791           R = (uint32_t)(ts->Q_s - Q * SECSPERWEEK);
792 
793 #   elif defined(UINT64_MAX) && !defined(__arm__)
794 
795           if (ts->q_s < 0)
796                     Q = ~(uint32_t)(~ts->Q_s / SECSPERWEEK);
797           else
798                     Q =  (uint32_t)( ts->Q_s / SECSPERWEEK);
799           R = ts->D_s.lo - Q * SECSPERWEEK;
800 
801 #   else
802 
803           /* Remember: 7*86400 <--> 604800 <--> 128 * 4725 */
804           uint32_t al = ts->D_s.lo;
805           uint32_t ah = ts->D_s.hi;
806 
807           al = (al >> 7) | (ah << 25);
808           ah = (ah >> 7) & 0x00FFFFFF;
809 
810           R  = (ts->d_s.hi < 0) ? 2264 : 0;/* sign bit value */
811           R += (al & 0xFFFF);
812           R += (al >> 16       ) * 4111u;         /* 2**16 % 4725 */
813           R += (ah & 0xFFFF) * 3721u;   /* 2**32 % 4725 */
814           R += (ah >> 16       ) * 2206u;         /* 2**48 % 4725 */
815           R %= 4725u;                             /* final reduction */
816           Q  = (al - R) * 0x98BBADDDu;  /* modinv(4725, 2**32) */
817           R  = (R << 7) | (ts->d_s.lo & 0x07F);
818 
819 #   endif
820 
821           res.hi = uint32_2cpl_to_int32(Q);
822           res.lo = R;
823 
824           return res;
825 }
826 
827 /*
828  *---------------------------------------------------------------------
829  * Split a 32bit seconds value into h/m/s and excessive days.  This
830  * function happily accepts negative time values as timestamps before
831  * midnight.
832  *---------------------------------------------------------------------
833  */
834 static int32_t
priv_timesplit(int32_t split[3],int32_t ts)835 priv_timesplit(
836           int32_t split[3],
837           int32_t ts
838           )
839 {
840           /* Do 3 chained floor divisions by positive constants, using the
841            * one's complement trick and factoring out the intermediate XOR
842            * ops to reduce the number of operations.
843            */
844           uint32_t us, um, uh, ud, sf32;
845 
846           sf32 = int32_sflag(ts);
847 
848           us = (uint32_t)ts;
849           um = (sf32 ^ us) / SECSPERMIN;
850           uh = um / MINSPERHR;
851           ud = uh / HRSPERDAY;
852 
853           um ^= sf32;
854           uh ^= sf32;
855           ud ^= sf32;
856 
857           split[0] = (int32_t)(uh - ud * HRSPERDAY );
858           split[1] = (int32_t)(um - uh * MINSPERHR );
859           split[2] = (int32_t)(us - um * SECSPERMIN);
860 
861           return uint32_2cpl_to_int32(ud);
862 }
863 
864 /*
865  *---------------------------------------------------------------------
866  * Given the number of elapsed days in the calendar era, split this
867  * number into the number of elapsed years in 'res.hi' and the number
868  * of elapsed days of that year in 'res.lo'.
869  *
870  * if 'isleapyear' is not NULL, it will receive an integer that is 0 for
871  * regular years and a non-zero value for leap years.
872  *---------------------------------------------------------------------
873  */
874 ntpcal_split
ntpcal_split_eradays(int32_t days,int * isleapyear)875 ntpcal_split_eradays(
876           int32_t days,
877           int  *isleapyear
878           )
879 {
880           /* Use the fast cycle split algorithm here, to calculate the
881            * centuries and years in a century with one division each. This
882            * reduces the number of division operations to two, but is
883            * susceptible to internal range overflow. We take some extra
884            * steps to avoid the gap.
885            */
886           ntpcal_split res;
887           int32_t    n100, n001; /* calendar year cycles */
888           uint32_t uday, Q;
889 
890           /* split off centuries first
891            *
892            * We want to execute '(days * 4 + 3) /% 146097' under floor
893            * division rules in the first step. Well, actually we want to
894            * calculate 'floor((days + 0.75) / 36524.25)', but we want to
895            * do it in scaled integer calculation.
896            */
897 #   if defined(HAVE_64BITREGS)
898 
899           /* not too complicated with an intermediate 64bit value */
900           uint64_t  ud64, sf64;
901           ud64 = ((uint64_t)days << 2) | 3u;
902           sf64 = (uint64_t)-(days < 0);
903           Q    = (uint32_t)(sf64 ^ ((sf64 ^ ud64) / GREGORIAN_CYCLE_DAYS));
904           uday = (uint32_t)(ud64 - Q * GREGORIAN_CYCLE_DAYS);
905           n100 = uint32_2cpl_to_int32(Q);
906 
907 #   else
908 
909           /* '4*days+3' suffers from range overflow when going to the
910            * limits. We solve this by doing an exact division (mod 2^32)
911            * after caclulating the remainder first.
912            *
913            * We start with a partial reduction by digit sums, extracting
914            * the upper bits from the original value before they get lost
915            * by scaling, and do one full division step to get the true
916            * remainder.  Then a final multiplication with the
917            * multiplicative inverse of 146097 (mod 2^32) gives us the full
918            * quotient.
919            *
920            * (-2^33) % 146097 --> 130717    : the sign bit value
921            * ( 2^20) % 146097 --> 25897     : the upper digit value
922            * modinv(146097, 2^32) --> 660721233 : the inverse
923            */
924           uint32_t ux = ((uint32_t)days << 2) | 3;
925           uday  = (days < 0) ? 130717u : 0u;          /* sign dgt */
926           uday += ((days >> 18) & 0x01FFFu) * 25897u; /* hi dgt (src!) */
927           uday += (ux & 0xFFFFFu);                    /* lo dgt */
928           uday %= GREGORIAN_CYCLE_DAYS;               /* full reduction */
929           Q     = (ux  - uday) * 660721233u;          /* exact div */
930           n100  = uint32_2cpl_to_int32(Q);
931 
932 #   endif
933 
934           /* Split off years in century -- days >= 0 here, and we're far
935            * away from integer overflow trouble now. */
936           uday |= 3;
937           n001  = uday / GREGORIAN_NORMAL_LEAP_CYCLE_DAYS;
938           uday -= n001 * GREGORIAN_NORMAL_LEAP_CYCLE_DAYS;
939 
940           /* Assemble the year and day in year */
941           res.hi = n100 * 100 + n001;
942           res.lo = uday / 4u;
943 
944           /* Possibly set the leap year flag */
945           if (isleapyear) {
946                     uint32_t tc = (uint32_t)n100 + 1;
947                     uint32_t ty = (uint32_t)n001 + 1;
948                     *isleapyear = !(ty & 3)
949                         && ((ty != 100) || !(tc & 3));
950           }
951           return res;
952 }
953 
954 /*
955  *---------------------------------------------------------------------
956  * Given a number of elapsed days in a year and a leap year indicator,
957  * split the number of elapsed days into the number of elapsed months in
958  * 'res.hi' and the number of elapsed days of that month in 'res.lo'.
959  *
960  * This function will fail and return {-1,-1} if the number of elapsed
961  * days is not in the valid range!
962  *---------------------------------------------------------------------
963  */
964 ntpcal_split
ntpcal_split_yeardays(int32_t eyd,int isleap)965 ntpcal_split_yeardays(
966           int32_t eyd,
967           int       isleap
968           )
969 {
970           /* Use the unshifted-year, February-with-30-days approach here.
971            * Fractional interpolations are used in both directions, with
972            * the smallest power-of-two divider to avoid any true division.
973            */
974           ntpcal_split        res = {-1, -1};
975 
976           /* convert 'isleap' to number of defective days */
977           isleap = 1 + !isleap;
978           /* adjust for February of 30 nominal days */
979           if (eyd >= 61 - isleap)
980                     eyd += isleap;
981           /* if in range, convert to months and days in month */
982           if (eyd >= 0 && eyd < 367) {
983                     res.hi = (eyd * 67 + 32) >> 11;
984                     res.lo = eyd - ((489 * res.hi + 8) >> 4);
985           }
986 
987           return res;
988 }
989 
990 /*
991  *---------------------------------------------------------------------
992  * Convert a RD into the date part of a 'struct calendar'.
993  *---------------------------------------------------------------------
994  */
995 int
ntpcal_rd_to_date(struct calendar * jd,int32_t rd)996 ntpcal_rd_to_date(
997           struct calendar *jd,
998           int32_t              rd
999           )
1000 {
1001           ntpcal_split split;
1002           int            leapy;
1003           u_int          ymask;
1004 
1005           /* Get day-of-week first. It's simply the RD (mod 7)... */
1006           jd->weekday = i32mod7(rd);
1007 
1008           split = ntpcal_split_eradays(rd - 1, &leapy);
1009           /* Get year and day-of-year, with overflow check. If any of the
1010            * upper 16 bits is set after shifting to unity-based years, we
1011            * will have an overflow when converting to an unsigned 16bit
1012            * year. Shifting to the right is OK here, since it does not
1013            * matter if the shift is logic or arithmetic.
1014            */
1015           split.hi += 1;
1016           ymask = 0u - ((split.hi >> 16) == 0);
1017           jd->year = (uint16_t)(split.hi & ymask);
1018           jd->yearday = (uint16_t)split.lo + 1;
1019 
1020           /* convert to month and mday */
1021           split = ntpcal_split_yeardays(split.lo, leapy);
1022           jd->month    = (uint8_t)split.hi + 1;
1023           jd->monthday = (uint8_t)split.lo + 1;
1024 
1025           return ymask ? leapy : -1;
1026 }
1027 
1028 /*
1029  *---------------------------------------------------------------------
1030  * Convert a RD into the date part of a 'struct tm'.
1031  *---------------------------------------------------------------------
1032  */
1033 int
ntpcal_rd_to_tm(struct tm * utm,int32_t rd)1034 ntpcal_rd_to_tm(
1035           struct tm  *utm,
1036           int32_t       rd
1037           )
1038 {
1039           ntpcal_split split;
1040           int            leapy;
1041 
1042           /* get day-of-week first */
1043           utm->tm_wday = i32mod7(rd);
1044 
1045           /* get year and day-of-year */
1046           split = ntpcal_split_eradays(rd - 1, &leapy);
1047           utm->tm_year = split.hi - 1899;
1048           utm->tm_yday = split.lo;      /* 0-based */
1049 
1050           /* convert to month and mday */
1051           split = ntpcal_split_yeardays(split.lo, leapy);
1052           utm->tm_mon  = split.hi;      /* 0-based */
1053           utm->tm_mday = split.lo + 1;  /* 1-based */
1054 
1055           return leapy;
1056 }
1057 
1058 /*
1059  *---------------------------------------------------------------------
1060  * Take a value of seconds since midnight and split it into hhmmss in a
1061  * 'struct calendar'.
1062  *---------------------------------------------------------------------
1063  */
1064 int32_t
ntpcal_daysec_to_date(struct calendar * jd,int32_t sec)1065 ntpcal_daysec_to_date(
1066           struct calendar *jd,
1067           int32_t             sec
1068           )
1069 {
1070           int32_t days;
1071           int   ts[3];
1072 
1073           days = priv_timesplit(ts, sec);
1074           jd->hour   = (uint8_t)ts[0];
1075           jd->minute = (uint8_t)ts[1];
1076           jd->second = (uint8_t)ts[2];
1077 
1078           return days;
1079 }
1080 
1081 /*
1082  *---------------------------------------------------------------------
1083  * Take a value of seconds since midnight and split it into hhmmss in a
1084  * 'struct tm'.
1085  *---------------------------------------------------------------------
1086  */
1087 int32_t
ntpcal_daysec_to_tm(struct tm * utm,int32_t sec)1088 ntpcal_daysec_to_tm(
1089           struct tm *utm,
1090           int32_t      sec
1091           )
1092 {
1093           int32_t days;
1094           int32_t ts[3];
1095 
1096           days = priv_timesplit(ts, sec);
1097           utm->tm_hour = ts[0];
1098           utm->tm_min  = ts[1];
1099           utm->tm_sec  = ts[2];
1100 
1101           return days;
1102 }
1103 
1104 /*
1105  *---------------------------------------------------------------------
1106  * take a split representation for day/second-of-day and day offset
1107  * and convert it to a 'struct calendar'. The seconds will be normalised
1108  * into the range of a day, and the day will be adjusted accordingly.
1109  *
1110  * returns >0 if the result is in a leap year, 0 if in a regular
1111  * year and <0 if the result did not fit into the calendar struct.
1112  *---------------------------------------------------------------------
1113  */
1114 int
ntpcal_daysplit_to_date(struct calendar * jd,const ntpcal_split * ds,int32_t dof)1115 ntpcal_daysplit_to_date(
1116           struct calendar        *jd,
1117           const ntpcal_split *ds,
1118           int32_t                 dof
1119           )
1120 {
1121           dof += ntpcal_daysec_to_date(jd, ds->lo);
1122           return ntpcal_rd_to_date(jd, ds->hi + dof);
1123 }
1124 
1125 /*
1126  *---------------------------------------------------------------------
1127  * take a split representation for day/second-of-day and day offset
1128  * and convert it to a 'struct tm'. The seconds will be normalised
1129  * into the range of a day, and the day will be adjusted accordingly.
1130  *
1131  * returns 1 if the result is in a leap year and zero if in a regular
1132  * year.
1133  *---------------------------------------------------------------------
1134  */
1135 int
ntpcal_daysplit_to_tm(struct tm * utm,const ntpcal_split * ds,int32_t dof)1136 ntpcal_daysplit_to_tm(
1137           struct tm    *utm,
1138           const ntpcal_split *ds ,
1139           int32_t                 dof
1140           )
1141 {
1142           dof += ntpcal_daysec_to_tm(utm, ds->lo);
1143 
1144           return ntpcal_rd_to_tm(utm, ds->hi + dof);
1145 }
1146 
1147 /*
1148  *---------------------------------------------------------------------
1149  * Take a UN*X time and convert to a calendar structure.
1150  *---------------------------------------------------------------------
1151  */
1152 int
ntpcal_time_to_date(struct calendar * jd,const vint64 * ts)1153 ntpcal_time_to_date(
1154           struct calendar     *jd,
1155           const vint64        *ts
1156           )
1157 {
1158           ntpcal_split ds;
1159 
1160           ds = ntpcal_daysplit(ts);
1161           ds.hi += ntpcal_daysec_to_date(jd, ds.lo);
1162           ds.hi += DAY_UNIX_STARTS;
1163 
1164           return ntpcal_rd_to_date(jd, ds.hi);
1165 }
1166 
1167 
1168 /*
1169  * ====================================================================
1170  *
1171  * merging composite entities
1172  *
1173  * ====================================================================
1174  */
1175 
1176 #if !defined(HAVE_INT64)
1177 /* multiplication helper. Seconds in days and weeks are multiples of 128,
1178  * and without that factor fit well into 16 bit. So a multiplication
1179  * of 32bit by 16bit and some shifting can be used on pure 32bit machines
1180  * with compilers that do not support 64bit integers.
1181  *
1182  * Calculate ( hi * mul * 128 ) + lo
1183  */
1184 static vint64
_dwjoin(uint16_t mul,int32_t hi,int32_t lo)1185 _dwjoin(
1186           uint16_t  mul,
1187           int32_t             hi,
1188           int32_t             lo
1189           )
1190 {
1191           vint64              res;
1192           uint32_t  p1, p2, sf;
1193 
1194           /* get sign flag and absolute value of 'hi' in p1 */
1195           sf = (uint32_t)-(hi < 0);
1196           p1 = ((uint32_t)hi + sf) ^ sf;
1197 
1198           /* assemble major units: res <- |hi| * mul */
1199           res.D_s.lo = (p1 & 0xFFFF) * mul;
1200           res.D_s.hi = 0;
1201           p1 = (p1 >> 16) * mul;
1202           p2 = p1 >> 16;
1203           p1 = p1 << 16;
1204           M_ADD(res.D_s.hi, res.D_s.lo, p2, p1);
1205 
1206           /* mul by 128, using shift: res <-- res << 7 */
1207           res.D_s.hi = (res.D_s.hi << 7) | (res.D_s.lo >> 25);
1208           res.D_s.lo = (res.D_s.lo << 7);
1209 
1210           /* fix up sign: res <-- (res + [sf|sf]) ^ [sf|sf] */
1211           M_ADD(res.D_s.hi, res.D_s.lo, sf, sf);
1212           res.D_s.lo ^= sf;
1213           res.D_s.hi ^= sf;
1214 
1215           /* properly add seconds: res <-- res + [sx(lo)|lo] */
1216           p2 = (uint32_t)-(lo < 0);
1217           p1 = (uint32_t)lo;
1218           M_ADD(res.D_s.hi, res.D_s.lo, p2, p1);
1219           return res;
1220 }
1221 #endif
1222 
1223 /*
1224  *---------------------------------------------------------------------
1225  * Merge a number of days and a number of seconds into seconds,
1226  * expressed in 64 bits to avoid overflow.
1227  *---------------------------------------------------------------------
1228  */
1229 vint64
ntpcal_dayjoin(int32_t days,int32_t secs)1230 ntpcal_dayjoin(
1231           int32_t days,
1232           int32_t secs
1233           )
1234 {
1235           vint64 res;
1236 
1237 #   if defined(HAVE_INT64)
1238 
1239           res.q_s    = days;
1240           res.q_s *= SECSPERDAY;
1241           res.q_s += secs;
1242 
1243 #   else
1244 
1245           res = _dwjoin(675, days, secs);
1246 
1247 #   endif
1248 
1249           return res;
1250 }
1251 
1252 /*
1253  *---------------------------------------------------------------------
1254  * Merge a number of weeks and a number of seconds into seconds,
1255  * expressed in 64 bits to avoid overflow.
1256  *---------------------------------------------------------------------
1257  */
1258 vint64
ntpcal_weekjoin(int32_t week,int32_t secs)1259 ntpcal_weekjoin(
1260           int32_t week,
1261           int32_t secs
1262           )
1263 {
1264           vint64 res;
1265 
1266 #   if defined(HAVE_INT64)
1267 
1268           res.q_s    = week;
1269           res.q_s *= SECSPERWEEK;
1270           res.q_s += secs;
1271 
1272 #   else
1273 
1274           res = _dwjoin(4725, week, secs);
1275 
1276 #   endif
1277 
1278           return res;
1279 }
1280 
1281 /*
1282  *---------------------------------------------------------------------
1283  * get leap years since epoch in elapsed years
1284  *---------------------------------------------------------------------
1285  */
1286 int32_t
ntpcal_leapyears_in_years(int32_t years)1287 ntpcal_leapyears_in_years(
1288           int32_t years
1289           )
1290 {
1291           /* We use the in-out-in algorithm here, using the one's
1292            * complement division trick for negative numbers. The chained
1293            * division sequence by 4/25/4 gives the compiler the chance to
1294            * get away with only one true division and doing shifts otherwise.
1295            */
1296 
1297           uint32_t sf32, sum, uyear;
1298 
1299           sf32  = int32_sflag(years);
1300           uyear = (uint32_t)years;
1301           uyear ^= sf32;
1302 
1303           sum  = (uyear /=  4u);        /*   4yr rule --> IN  */
1304           sum -= (uyear /= 25u);        /* 100yr rule --> OUT */
1305           sum += (uyear /=  4u);        /* 400yr rule --> IN  */
1306 
1307           /* Thanks to the alternation of IN/OUT/IN we can do the sum
1308            * directly and have a single one's complement operation
1309            * here. (Only if the years are negative, of course.) Otherwise
1310            * the one's complement would have to be done when
1311            * adding/subtracting the terms.
1312            */
1313           return uint32_2cpl_to_int32(sf32 ^ sum);
1314 }
1315 
1316 /*
1317  *---------------------------------------------------------------------
1318  * Convert elapsed years in Era into elapsed days in Era.
1319  *---------------------------------------------------------------------
1320  */
1321 int32_t
ntpcal_days_in_years(int32_t years)1322 ntpcal_days_in_years(
1323           int32_t years
1324           )
1325 {
1326           return years * DAYSPERYEAR + ntpcal_leapyears_in_years(years);
1327 }
1328 
1329 /*
1330  *---------------------------------------------------------------------
1331  * Convert a number of elapsed month in a year into elapsed days in year.
1332  *
1333  * The month will be normalized, and 'res.hi' will contain the
1334  * excessive years that must be considered when converting the years,
1335  * while 'res.lo' will contain the number of elapsed days since start
1336  * of the year.
1337  *
1338  * This code uses the shifted-month-approach to convert month to days,
1339  * because then there is no need to have explicit leap year
1340  * information.      The slight disadvantage is that for most month values
1341  * the result is a negative value, and the year excess is one; the
1342  * conversion is then simply based on the start of the following year.
1343  *---------------------------------------------------------------------
1344  */
1345 ntpcal_split
ntpcal_days_in_months(int32_t m)1346 ntpcal_days_in_months(
1347           int32_t m
1348           )
1349 {
1350           ntpcal_split res;
1351 
1352           /* Add ten months with proper year adjustment. */
1353           if (m < 2) {
1354               res.lo  = m + 10;
1355               res.hi  = 0;
1356           } else {
1357               res.lo  = m - 2;
1358               res.hi  = 1;
1359           }
1360 
1361           /* Possibly normalise by floor division. This does not hapen for
1362            * input in normal range. */
1363           if (res.lo < 0 || res.lo >= 12) {
1364                     uint32_t mu, Q, sf32;
1365                     sf32 = int32_sflag(res.lo);
1366                     mu   = (uint32_t)res.lo;
1367                     Q    = sf32 ^ ((sf32 ^ mu) / 12u);
1368 
1369                     res.hi += uint32_2cpl_to_int32(Q);
1370                     res.lo    = mu - Q * 12u;
1371           }
1372 
1373           /* Get cummulated days in year with unshift. Use the fractional
1374            * interpolation with smallest possible power of two in the
1375            * divider.
1376            */
1377           res.lo = ((res.lo * 979 + 16) >> 5) - 306;
1378 
1379           return res;
1380 }
1381 
1382 /*
1383  *---------------------------------------------------------------------
1384  * Convert ELAPSED years/months/days of gregorian calendar to elapsed
1385  * days in Gregorian epoch.
1386  *
1387  * If you want to convert years and days-of-year, just give a month of
1388  * zero.
1389  *---------------------------------------------------------------------
1390  */
1391 int32_t
ntpcal_edate_to_eradays(int32_t years,int32_t mons,int32_t mdays)1392 ntpcal_edate_to_eradays(
1393           int32_t years,
1394           int32_t mons,
1395           int32_t mdays
1396           )
1397 {
1398           ntpcal_split tmp;
1399           int32_t        res;
1400 
1401           if (mons) {
1402                     tmp = ntpcal_days_in_months(mons);
1403                     res = ntpcal_days_in_years(years + tmp.hi) + tmp.lo;
1404           } else
1405                     res = ntpcal_days_in_years(years);
1406           res += mdays;
1407 
1408           return res;
1409 }
1410 
1411 /*
1412  *---------------------------------------------------------------------
1413  * Convert ELAPSED years/months/days of gregorian calendar to elapsed
1414  * days in year.
1415  *
1416  * Note: This will give the true difference to the start of the given
1417  * year, even if months & days are off-scale.
1418  *---------------------------------------------------------------------
1419  */
1420 int32_t
ntpcal_edate_to_yeardays(int32_t years,int32_t mons,int32_t mdays)1421 ntpcal_edate_to_yeardays(
1422           int32_t years,
1423           int32_t mons,
1424           int32_t mdays
1425           )
1426 {
1427           ntpcal_split tmp;
1428 
1429           if (0 <= mons && mons < 12) {
1430                     if (mons >= 2)
1431                               mdays -= 2 - is_leapyear(years+1);
1432                     mdays += (489 * mons + 8) >> 4;
1433           } else {
1434                     tmp = ntpcal_days_in_months(mons);
1435                     mdays += tmp.lo
1436                            + ntpcal_days_in_years(years + tmp.hi)
1437                            - ntpcal_days_in_years(years);
1438           }
1439 
1440           return mdays;
1441 }
1442 
1443 /*
1444  *---------------------------------------------------------------------
1445  * Convert elapsed days and the hour/minute/second information into
1446  * total seconds.
1447  *
1448  * If 'isvalid' is not NULL, do a range check on the time specification
1449  * and tell if the time input is in the normal range, permitting for a
1450  * single leapsecond.
1451  *---------------------------------------------------------------------
1452  */
1453 int32_t
ntpcal_etime_to_seconds(int32_t hours,int32_t minutes,int32_t seconds)1454 ntpcal_etime_to_seconds(
1455           int32_t hours,
1456           int32_t minutes,
1457           int32_t seconds
1458           )
1459 {
1460           int32_t res;
1461 
1462           res = (hours * MINSPERHR + minutes) * SECSPERMIN + seconds;
1463 
1464           return res;
1465 }
1466 
1467 /*
1468  *---------------------------------------------------------------------
1469  * Convert the date part of a 'struct tm' (that is, year, month,
1470  * day-of-month) into the RD of that day.
1471  *---------------------------------------------------------------------
1472  */
1473 int32_t
ntpcal_tm_to_rd(const struct tm * utm)1474 ntpcal_tm_to_rd(
1475           const struct tm *utm
1476           )
1477 {
1478           return ntpcal_edate_to_eradays(utm->tm_year + 1899,
1479                                                utm->tm_mon,
1480                                                utm->tm_mday - 1) + 1;
1481 }
1482 
1483 /*
1484  *---------------------------------------------------------------------
1485  * Convert the date part of a 'struct calendar' (that is, year, month,
1486  * day-of-month) into the RD of that day.
1487  *---------------------------------------------------------------------
1488  */
1489 int32_t
ntpcal_date_to_rd(const struct calendar * jd)1490 ntpcal_date_to_rd(
1491           const struct calendar *jd
1492           )
1493 {
1494           return ntpcal_edate_to_eradays((int32_t)jd->year - 1,
1495                                                (int32_t)jd->month - 1,
1496                                                (int32_t)jd->monthday - 1) + 1;
1497 }
1498 
1499 /*
1500  *---------------------------------------------------------------------
1501  * convert a year number to rata die of year start
1502  *---------------------------------------------------------------------
1503  */
1504 int32_t
ntpcal_year_to_ystart(int32_t year)1505 ntpcal_year_to_ystart(
1506           int32_t year
1507           )
1508 {
1509           return ntpcal_days_in_years(year - 1) + 1;
1510 }
1511 
1512 /*
1513  *---------------------------------------------------------------------
1514  * For a given RD, get the RD of the associated year start,
1515  * that is, the RD of the last January,1st on or before that day.
1516  *---------------------------------------------------------------------
1517  */
1518 int32_t
ntpcal_rd_to_ystart(int32_t rd)1519 ntpcal_rd_to_ystart(
1520           int32_t rd
1521           )
1522 {
1523           /*
1524            * Rather simple exercise: split the day number into elapsed
1525            * years and elapsed days, then remove the elapsed days from the
1526            * input value. Nice'n sweet...
1527            */
1528           return rd - ntpcal_split_eradays(rd - 1, NULL).lo;
1529 }
1530 
1531 /*
1532  *---------------------------------------------------------------------
1533  * For a given RD, get the RD of the associated month start.
1534  *---------------------------------------------------------------------
1535  */
1536 int32_t
ntpcal_rd_to_mstart(int32_t rd)1537 ntpcal_rd_to_mstart(
1538           int32_t rd
1539           )
1540 {
1541           ntpcal_split split;
1542           int            leaps;
1543 
1544           split = ntpcal_split_eradays(rd - 1, &leaps);
1545           split = ntpcal_split_yeardays(split.lo, leaps);
1546 
1547           return rd - split.lo;
1548 }
1549 
1550 /*
1551  *---------------------------------------------------------------------
1552  * take a 'struct calendar' and get the seconds-of-day from it.
1553  *---------------------------------------------------------------------
1554  */
1555 int32_t
ntpcal_date_to_daysec(const struct calendar * jd)1556 ntpcal_date_to_daysec(
1557           const struct calendar *jd
1558           )
1559 {
1560           return ntpcal_etime_to_seconds(jd->hour, jd->minute,
1561                                                jd->second);
1562 }
1563 
1564 /*
1565  *---------------------------------------------------------------------
1566  * take a 'struct tm' and get the seconds-of-day from it.
1567  *---------------------------------------------------------------------
1568  */
1569 int32_t
ntpcal_tm_to_daysec(const struct tm * utm)1570 ntpcal_tm_to_daysec(
1571           const struct tm *utm
1572           )
1573 {
1574           return ntpcal_etime_to_seconds(utm->tm_hour, utm->tm_min,
1575                                                utm->tm_sec);
1576 }
1577 
1578 /*
1579  *---------------------------------------------------------------------
1580  * take a 'struct calendar' and convert it to a 'time_t'
1581  *---------------------------------------------------------------------
1582  */
1583 time_t
ntpcal_date_to_time(const struct calendar * jd)1584 ntpcal_date_to_time(
1585           const struct calendar *jd
1586           )
1587 {
1588           vint64    join;
1589           int32_t days, secs;
1590 
1591           days = ntpcal_date_to_rd(jd) - DAY_UNIX_STARTS;
1592           secs = ntpcal_date_to_daysec(jd);
1593           join = ntpcal_dayjoin(days, secs);
1594 
1595           return vint64_to_time(&join);
1596 }
1597 
1598 
1599 /*
1600  * ====================================================================
1601  *
1602  * extended and unchecked variants of caljulian/caltontp
1603  *
1604  * ====================================================================
1605  */
1606 int
ntpcal_ntp64_to_date(struct calendar * jd,const vint64 * ntp)1607 ntpcal_ntp64_to_date(
1608           struct calendar *jd,
1609           const vint64        *ntp
1610           )
1611 {
1612           ntpcal_split ds;
1613 
1614           ds = ntpcal_daysplit(ntp);
1615           ds.hi += ntpcal_daysec_to_date(jd, ds.lo);
1616 
1617           return ntpcal_rd_to_date(jd, ds.hi + DAY_NTP_STARTS);
1618 }
1619 
1620 int
ntpcal_ntp_to_date(struct calendar * jd,uint32_t ntp,const time_t * piv)1621 ntpcal_ntp_to_date(
1622           struct calendar *jd,
1623           uint32_t   ntp,
1624           const time_t        *piv
1625           )
1626 {
1627           vint64    ntp64;
1628 
1629           /*
1630            * Unfold ntp time around current time into NTP domain. Split
1631            * into days and seconds, shift days into CE domain and
1632            * process the parts.
1633            */
1634           ntp64 = ntpcal_ntp_to_ntp(ntp, piv);
1635           return ntpcal_ntp64_to_date(jd, &ntp64);
1636 }
1637 
1638 
1639 vint64
ntpcal_date_to_ntp64(const struct calendar * jd)1640 ntpcal_date_to_ntp64(
1641           const struct calendar *jd
1642           )
1643 {
1644           /*
1645            * Convert date to NTP. Ignore yearday, use d/m/y only.
1646            */
1647           return ntpcal_dayjoin(ntpcal_date_to_rd(jd) - DAY_NTP_STARTS,
1648                                     ntpcal_date_to_daysec(jd));
1649 }
1650 
1651 
1652 uint32_t
ntpcal_date_to_ntp(const struct calendar * jd)1653 ntpcal_date_to_ntp(
1654           const struct calendar *jd
1655           )
1656 {
1657           /*
1658            * Get lower half of 64bit NTP timestamp from date/time.
1659            */
1660           return ntpcal_date_to_ntp64(jd).d_s.lo;
1661 }
1662 
1663 
1664 
1665 /*
1666  * ====================================================================
1667  *
1668  * day-of-week calculations
1669  *
1670  * ====================================================================
1671  */
1672 /*
1673  * Given a RataDie and a day-of-week, calculate a RDN that is reater-than,
1674  * greater-or equal, closest, less-or-equal or less-than the given RDN
1675  * and denotes the given day-of-week
1676  */
1677 int32_t
ntpcal_weekday_gt(int32_t rdn,int32_t dow)1678 ntpcal_weekday_gt(
1679           int32_t rdn,
1680           int32_t dow
1681           )
1682 {
1683           return ntpcal_periodic_extend(rdn+1, dow, 7);
1684 }
1685 
1686 int32_t
ntpcal_weekday_ge(int32_t rdn,int32_t dow)1687 ntpcal_weekday_ge(
1688           int32_t rdn,
1689           int32_t dow
1690           )
1691 {
1692           return ntpcal_periodic_extend(rdn, dow, 7);
1693 }
1694 
1695 int32_t
ntpcal_weekday_close(int32_t rdn,int32_t dow)1696 ntpcal_weekday_close(
1697           int32_t rdn,
1698           int32_t dow
1699           )
1700 {
1701           return ntpcal_periodic_extend(rdn-3, dow, 7);
1702 }
1703 
1704 int32_t
ntpcal_weekday_le(int32_t rdn,int32_t dow)1705 ntpcal_weekday_le(
1706           int32_t rdn,
1707           int32_t dow
1708           )
1709 {
1710           return ntpcal_periodic_extend(rdn, dow, -7);
1711 }
1712 
1713 int32_t
ntpcal_weekday_lt(int32_t rdn,int32_t dow)1714 ntpcal_weekday_lt(
1715           int32_t rdn,
1716           int32_t dow
1717           )
1718 {
1719           return ntpcal_periodic_extend(rdn-1, dow, -7);
1720 }
1721 
1722 /*
1723  * ====================================================================
1724  *
1725  * ISO week-calendar conversions
1726  *
1727  * The ISO8601 calendar defines a calendar of years, weeks and weekdays.
1728  * It is related to the Gregorian calendar, and a ISO year starts at the
1729  * Monday closest to Jan,1st of the corresponding Gregorian year.  A ISO
1730  * calendar year has always 52 or 53 weeks, and like the Grogrian
1731  * calendar the ISO8601 calendar repeats itself every 400 years, or
1732  * 146097 days, or 20871 weeks.
1733  *
1734  * While it is possible to write ISO calendar functions based on the
1735  * Gregorian calendar functions, the following implementation takes a
1736  * different approach, based directly on years and weeks.
1737  *
1738  * Analysis of the tabulated data shows that it is not possible to
1739  * interpolate from years to weeks over a full 400 year range; cyclic
1740  * shifts over 400 years do not provide a solution here. But it *is*
1741  * possible to interpolate over every single century of the 400-year
1742  * cycle. (The centennial leap year rule seems to be the culprit here.)
1743  *
1744  * It can be shown that a conversion from years to weeks can be done
1745  * using a linear transformation of the form
1746  *
1747  *   w = floor( y * a + b )
1748  *
1749  * where the slope a must hold to
1750  *
1751  *  52.1780821918 <= a < 52.1791044776
1752  *
1753  * and b must be chosen according to the selected slope and the number
1754  * of the century in a 400-year period.
1755  *
1756  * The inverse calculation can also be done in this way. Careful scaling
1757  * provides an unlimited set of integer coefficients a,k,b that enable
1758  * us to write the calulation in the form
1759  *
1760  *   w = (y * a      + b ) / k
1761  *   y = (w * a' + b') / k'
1762  *
1763  * In this implementation the values of k and k' are chosen to be the
1764  * smallest possible powers of two, so the division can be implemented
1765  * as shifts if the optimiser chooses to do so.
1766  *
1767  * ====================================================================
1768  */
1769 
1770 /*
1771  * Given a number of elapsed (ISO-)years since the begin of the
1772  * christian era, return the number of elapsed weeks corresponding to
1773  * the number of years.
1774  */
1775 int32_t
isocal_weeks_in_years(int32_t years)1776 isocal_weeks_in_years(
1777           int32_t years
1778           )
1779 {
1780           /*
1781            * use: w = (y * 53431 + b[c]) / 1024 as interpolation
1782            */
1783           static const uint16_t bctab[4] = { 157, 449, 597, 889 };
1784 
1785           int32_t    cs, cw;
1786           uint32_t cc, ci, yu, sf32;
1787 
1788           sf32 = int32_sflag(years);
1789           yu   = (uint32_t)years;
1790 
1791           /* split off centuries, using floor division */
1792           cc  = sf32 ^ ((sf32 ^ yu) / 100u);
1793           yu -= cc * 100u;
1794 
1795           /* calculate century cycles shift and cycle index:
1796            * Assuming a century is 5217 weeks, we have to add a cycle
1797            * shift that is 3 for every 4 centuries, because 3 of the four
1798            * centuries have 5218 weeks. So '(cc*3 + 1) / 4' is the actual
1799            * correction, and the second century is the defective one.
1800            *
1801            * Needs floor division by 4, which is done with masking and
1802            * shifting.
1803            */
1804           ci = cc * 3u + 1;
1805           cs = uint32_2cpl_to_int32(sf32 ^ ((sf32 ^ ci) >> 2));
1806           ci = ci & 3u;
1807 
1808           /* Get weeks in century. Can use plain division here as all ops
1809            * are >= 0,  and let the compiler sort out the possible
1810            * optimisations.
1811            */
1812           cw = (yu * 53431u + bctab[ci]) / 1024u;
1813 
1814           return uint32_2cpl_to_int32(cc) * 5217 + cs + cw;
1815 }
1816 
1817 /*
1818  * Given a number of elapsed weeks since the begin of the christian
1819  * era, split this number into the number of elapsed years in res.hi
1820  * and the excessive number of weeks in res.lo. (That is, res.lo is
1821  * the number of elapsed weeks in the remaining partial year.)
1822  */
1823 ntpcal_split
isocal_split_eraweeks(int32_t weeks)1824 isocal_split_eraweeks(
1825           int32_t weeks
1826           )
1827 {
1828           /*
1829            * use: y = (w * 157 + b[c]) / 8192 as interpolation
1830            */
1831 
1832           static const uint16_t bctab[4] = { 85, 130, 17, 62 };
1833 
1834           ntpcal_split res;
1835           int32_t    cc, ci;
1836           uint32_t sw, cy, Q;
1837 
1838           /* Use two fast cycle-split divisions again. Herew e want to
1839            * execute '(weeks * 4 + 2) /% 20871' under floor division rules
1840            * in the first step.
1841            *
1842            * This is of course (again) susceptible to internal overflow if
1843            * coded directly in 32bit. And again we use 64bit division on
1844            * a 64bit target and exact division after calculating the
1845            * remainder first on a 32bit target. With the smaller divider,
1846            * that's even a bit neater.
1847            */
1848 #   if defined(HAVE_64BITREGS)
1849 
1850           /* Full floor division with 64bit values. */
1851           uint64_t sf64, sw64;
1852           sf64 = (uint64_t)-(weeks < 0);
1853           sw64 = ((uint64_t)weeks << 2) | 2u;
1854           Q    = (uint32_t)(sf64 ^ ((sf64 ^ sw64) / GREGORIAN_CYCLE_WEEKS));
1855           sw   = (uint32_t)(sw64 - Q * GREGORIAN_CYCLE_WEEKS);
1856 
1857 #   else
1858 
1859           /* Exact division after calculating the remainder via partial
1860            * reduction by digit sum.
1861            * (-2^33) % 20871     --> 5491              : the sign bit value
1862            * ( 2^20) % 20871     --> 5026              : the upper digit value
1863            * modinv(20871, 2^32) --> 330081335 : the inverse
1864            */
1865           uint32_t ux = ((uint32_t)weeks << 2) | 2;
1866           sw  = (weeks < 0) ? 5491u : 0u;                     /* sign dgt */
1867           sw += ((weeks >> 18) & 0x01FFFu) * 5026u; /* hi dgt (src!) */
1868           sw += (ux & 0xFFFFFu);                              /* lo dgt */
1869           sw %= GREGORIAN_CYCLE_WEEKS;              /* full reduction */
1870           Q   = (ux  - sw) * 330081335u;                      /* exact div */
1871 
1872 #   endif
1873 
1874           ci  = Q & 3u;
1875           cc  = uint32_2cpl_to_int32(Q);
1876 
1877           /* Split off years; sw >= 0 here! The scaled weeks in the years
1878            * are scaled up by 157 afterwards.
1879            */
1880           sw  = (sw / 4u) * 157u + bctab[ci];
1881           cy  = sw / 8192u;   /* sw >> 13 , let the compiler sort it out */
1882           sw  = sw % 8192u;   /* sw & 8191, let the compiler sort it out */
1883 
1884           /* assemble elapsed years and downscale the elapsed weeks in
1885            * the year.
1886            */
1887           res.hi = 100*cc + cy;
1888           res.lo = sw / 157u;
1889 
1890           return res;
1891 }
1892 
1893 /*
1894  * Given a second in the NTP time scale and a pivot, expand the NTP
1895  * time stamp around the pivot and convert into an ISO calendar time
1896  * stamp.
1897  */
1898 int
isocal_ntp64_to_date(struct isodate * id,const vint64 * ntp)1899 isocal_ntp64_to_date(
1900           struct isodate *id,
1901           const vint64   *ntp
1902           )
1903 {
1904           ntpcal_split ds;
1905           int32_t        ts[3];
1906           uint32_t     uw, ud, sf32;
1907 
1908           /*
1909            * Split NTP time into days and seconds, shift days into CE
1910            * domain and process the parts.
1911            */
1912           ds = ntpcal_daysplit(ntp);
1913 
1914           /* split time part */
1915           ds.hi += priv_timesplit(ts, ds.lo);
1916           id->hour   = (uint8_t)ts[0];
1917           id->minute = (uint8_t)ts[1];
1918           id->second = (uint8_t)ts[2];
1919 
1920           /* split days into days and weeks, using floor division in unsigned */
1921           ds.hi += DAY_NTP_STARTS - 1; /* shift from NTP to RDN */
1922           sf32 = int32_sflag(ds.hi);
1923           ud   = (uint32_t)ds.hi;
1924           uw   = sf32 ^ ((sf32 ^ ud) / DAYSPERWEEK);
1925           ud  -= uw * DAYSPERWEEK;
1926 
1927           ds.hi = uint32_2cpl_to_int32(uw);
1928           ds.lo = ud;
1929 
1930           id->weekday = (uint8_t)ds.lo + 1;       /* weekday result    */
1931 
1932           /* get year and week in year */
1933           ds = isocal_split_eraweeks(ds.hi);      /* elapsed years&week*/
1934           id->year = (uint16_t)ds.hi + 1;                   /* shift to current  */
1935           id->week = (uint8_t )ds.lo + 1;
1936 
1937           return (ds.hi >= 0 && ds.hi < 0x0000FFFF);
1938 }
1939 
1940 int
isocal_ntp_to_date(struct isodate * id,uint32_t ntp,const time_t * piv)1941 isocal_ntp_to_date(
1942           struct isodate *id,
1943           uint32_t  ntp,
1944           const time_t   *piv
1945           )
1946 {
1947           vint64    ntp64;
1948 
1949           /*
1950            * Unfold ntp time around current time into NTP domain, then
1951            * convert the full time stamp.
1952            */
1953           ntp64 = ntpcal_ntp_to_ntp(ntp, piv);
1954           return isocal_ntp64_to_date(id, &ntp64);
1955 }
1956 
1957 /*
1958  * Convert a ISO date spec into a second in the NTP time scale,
1959  * properly truncated to 32 bit.
1960  */
1961 vint64
isocal_date_to_ntp64(const struct isodate * id)1962 isocal_date_to_ntp64(
1963           const struct isodate *id
1964           )
1965 {
1966           int32_t weeks, days, secs;
1967 
1968           weeks = isocal_weeks_in_years((int32_t)id->year - 1)
1969                 + (int32_t)id->week - 1;
1970           days = weeks * 7 + (int32_t)id->weekday;
1971           /* days is RDN of ISO date now */
1972           secs = ntpcal_etime_to_seconds(id->hour, id->minute, id->second);
1973 
1974           return ntpcal_dayjoin(days - DAY_NTP_STARTS, secs);
1975 }
1976 
1977 uint32_t
isocal_date_to_ntp(const struct isodate * id)1978 isocal_date_to_ntp(
1979           const struct isodate *id
1980           )
1981 {
1982           /*
1983            * Get lower half of 64bit NTP timestamp from date/time.
1984            */
1985           return isocal_date_to_ntp64(id).d_s.lo;
1986 }
1987 
1988 /*
1989  * ====================================================================
1990  * 'basedate' support functions
1991  * ====================================================================
1992  */
1993 
1994 static int32_t s_baseday = NTP_TO_UNIX_DAYS;
1995 static int32_t s_gpsweek = 0;
1996 
1997 int32_t
basedate_eval_buildstamp(void)1998 basedate_eval_buildstamp(void)
1999 {
2000           struct calendar jd;
2001           int32_t             ed;
2002 
2003           if (!ntpcal_get_build_date(&jd))
2004                     return NTP_TO_UNIX_DAYS;
2005 
2006           /* The time zone of the build stamp is unspecified; we remove
2007            * one day to provide a certain slack. And in case somebody
2008            * fiddled with the system clock, we make sure we do not go
2009            * before the UNIX epoch (1970-01-01). It's probably not possible
2010            * to do this to the clock on most systems, but there are other
2011            * ways to tweak the build stamp.
2012            */
2013           jd.monthday -= 1;
2014           ed = ntpcal_date_to_rd(&jd) - DAY_NTP_STARTS;
2015           return (ed < NTP_TO_UNIX_DAYS) ? NTP_TO_UNIX_DAYS : ed;
2016 }
2017 
2018 int32_t
basedate_eval_string(const char * str)2019 basedate_eval_string(
2020           const char * str
2021           )
2022 {
2023           u_short   y,m,d;
2024           u_long    ned;
2025           int       rc, nc;
2026           size_t    sl;
2027 
2028           sl = strlen(str);
2029           rc = sscanf(str, "%4hu-%2hu-%2hu%n", &y, &m, &d, &nc);
2030           if (rc == 3 && (size_t)nc == sl) {
2031                     if (m >= 1 && m <= 12 && d >= 1 && d <= 31)
2032                               return ntpcal_edate_to_eradays(y-1, m-1, d)
2033                                   - DAY_NTP_STARTS;
2034                     goto buildstamp;
2035           }
2036 
2037           rc = sscanf(str, "%lu%n", &ned, &nc);
2038           if (rc == 1 && (size_t)nc == sl) {
2039                     if (ned <= INT32_MAX)
2040                               return (int32_t)ned;
2041                     goto buildstamp;
2042           }
2043 
2044   buildstamp:
2045           msyslog(LOG_WARNING,
2046                     "basedate string \"%s\" invalid, build date substituted!",
2047                     str);
2048           return basedate_eval_buildstamp();
2049 }
2050 
2051 uint32_t
basedate_get_day(void)2052 basedate_get_day(void)
2053 {
2054           return s_baseday;
2055 }
2056 
2057 int32_t
basedate_set_day(int32_t day)2058 basedate_set_day(
2059           int32_t day
2060           )
2061 {
2062           struct calendar     jd;
2063           int32_t             retv;
2064 
2065           /* set NTP base date for NTP era unfolding */
2066           if (day < NTP_TO_UNIX_DAYS) {
2067                     msyslog(LOG_WARNING,
2068                               "baseday_set_day: invalid day (%lu), UNIX epoch substituted",
2069                               (unsigned long)day);
2070                     day = NTP_TO_UNIX_DAYS;
2071           }
2072           retv = s_baseday;
2073           s_baseday = day;
2074           ntpcal_rd_to_date(&jd, day + DAY_NTP_STARTS);
2075           msyslog(LOG_INFO, "basedate set to %04hu-%02hu-%02hu",
2076                     jd.year, (u_short)jd.month, (u_short)jd.monthday);
2077 
2078           /* set GPS base week for GPS week unfolding */
2079           day = ntpcal_weekday_ge(day + DAY_NTP_STARTS, CAL_SUNDAY)
2080               - DAY_NTP_STARTS;
2081           if (day < NTP_TO_GPS_DAYS)
2082               day = NTP_TO_GPS_DAYS;
2083           s_gpsweek = (day - NTP_TO_GPS_DAYS) / DAYSPERWEEK;
2084           ntpcal_rd_to_date(&jd, day + DAY_NTP_STARTS);
2085           msyslog(LOG_INFO, "gps base set to %04hu-%02hu-%02hu (week %d)",
2086                     jd.year, (u_short)jd.month, (u_short)jd.monthday, s_gpsweek);
2087 
2088           return retv;
2089 }
2090 
2091 time_t
basedate_get_eracenter(void)2092 basedate_get_eracenter(void)
2093 {
2094           time_t retv;
2095           retv  = (time_t)(s_baseday - NTP_TO_UNIX_DAYS);
2096           retv *= SECSPERDAY;
2097           retv += (UINT32_C(1) << 31);
2098           return retv;
2099 }
2100 
2101 time_t
basedate_get_erabase(void)2102 basedate_get_erabase(void)
2103 {
2104           time_t retv;
2105           retv  = (time_t)(s_baseday - NTP_TO_UNIX_DAYS);
2106           retv *= SECSPERDAY;
2107           return retv;
2108 }
2109 
2110 uint32_t
basedate_get_gpsweek(void)2111 basedate_get_gpsweek(void)
2112 {
2113     return s_gpsweek;
2114 }
2115 
2116 uint32_t
basedate_expand_gpsweek(unsigned short weekno)2117 basedate_expand_gpsweek(
2118     unsigned short weekno
2119     )
2120 {
2121     /* We do a fast modulus expansion here. Since all quantities are
2122      * unsigned and we cannot go before the start of the GPS epoch
2123      * anyway, and since the truncated GPS week number is 10 bit, the
2124      * expansion becomes a simple sub/and/add sequence.
2125      */
2126     #if GPSWEEKS != 1024
2127     # error GPSWEEKS defined wrong -- should be 1024!
2128     #endif
2129 
2130     uint32_t diff;
2131     diff = ((uint32_t)weekno - s_gpsweek) & (GPSWEEKS - 1);
2132     return s_gpsweek + diff;
2133 }
2134 
2135 /*
2136  * ====================================================================
2137  * misc. helpers
2138  * ====================================================================
2139  */
2140 
2141 /* --------------------------------------------------------------------
2142  * reconstruct the centrury from a truncated date and a day-of-week
2143  *
2144  * Given a date with truncated year (2-digit, 0..99) and a day-of-week
2145  * from 1(Mon) to 7(Sun), recover the full year between 1900AD and 2300AD.
2146  */
2147 int32_t
ntpcal_expand_century(uint32_t y,uint32_t m,uint32_t d,uint32_t wd)2148 ntpcal_expand_century(
2149           uint32_t y,
2150           uint32_t m,
2151           uint32_t d,
2152           uint32_t wd)
2153 {
2154           /* This algorithm is short but tricky... It's related to
2155            * Zeller's congruence, partially done backwards.
2156            *
2157            * A few facts to remember:
2158            *  1) The Gregorian calendar has a cycle of 400 years.
2159            *  2) The weekday of the 1st day of a century shifts by 5 days
2160            *     during a great cycle.
2161            *  3) For calendar math, a century starts with the 1st year,
2162            *     which is year 1, !not! zero.
2163            *
2164            * So we start with taking the weekday difference (mod 7)
2165            * between the truncated date (which is taken as an absolute
2166            * date in the 1st century in the proleptic calendar) and the
2167            * weekday given.
2168            *
2169            * When dividing this residual by 5, we obtain the number of
2170            * centuries to add to the base. But since the residual is (mod
2171            * 7), we have to make this an exact division by multiplication
2172            * with the modular inverse of 5 (mod 7), which is 3:
2173            *    3*5 === 1 (mod 7).
2174            *
2175            * If this yields a result of 4/5/6, the given date/day-of-week
2176            * combination is impossible, and we return zero as resulting
2177            * year to indicate failure.
2178            *
2179            * Then we remap the century to the range starting with year
2180            * 1900.
2181            */
2182 
2183           uint32_t c;
2184 
2185           /* check basic constraints */
2186           if ((y >= 100u) || (--m >= 12u) || (--d >= 31u))
2187                     return 0;
2188 
2189           if ((m += 10u) >= 12u)                  /* shift base to prev. March,1st */
2190                     m -= 12u;
2191           else if (--y >= 100u)
2192                     y += 100u;
2193           d += y + (y >> 2) + 2u;                 /* year share */
2194           d += (m * 83u + 16u) >> 5;    /* month share */
2195 
2196           /* get (wd - d), shifted to positive value, and multiply with
2197            * 3(mod 7). (Exact division, see to comment)
2198            * Note: 1) d <= 184 at this point.
2199            *         2) 252 % 7 == 0, but 'wd' is off by one since we did
2200            *            '--d' above, so we add just 251 here!
2201            */
2202           c = u32mod7(3 * (251u + wd - d));
2203           if (c > 3u)
2204                     return 0;
2205 
2206           if ((m > 9u) && (++y >= 100u)) {/* undo base shift */
2207                     y -= 100u;
2208                     c = (c + 1) & 3u;
2209           }
2210           y += (c * 100u);              /* combine into 1st cycle */
2211           y += (y < 300u) ? 2000 : 1600;          /* map to destination era */
2212           return (int)y;
2213 }
2214 
2215 char *
ntpcal_iso8601std(char * buf,size_t len,TcCivilDate * cdp)2216 ntpcal_iso8601std(
2217           char *              buf,
2218           size_t              len,
2219           TcCivilDate *       cdp
2220           )
2221 {
2222           if (!buf) {
2223                     LIB_GETBUF(buf);
2224                     len = LIB_BUFLENGTH;
2225           }
2226           if (len) {
2227                     int slen = snprintf(buf, len, "%04u-%02u-%02uT%02u:%02u:%02u",
2228                                      cdp->year, cdp->month, cdp->monthday,
2229                                      cdp->hour, cdp->minute, cdp->second);
2230                     if (slen < 0)
2231                               *buf = '\0';
2232           }
2233           return buf;
2234 }
2235 
2236 /* -*-EOF-*- */
2237