contrib/ntp/adjtimed/adjtimed.c

   1 /*************************************************************************/
   2 /* (c) Copyright Tai Jin, 1988.  All Rights Reserved.                    */
   3 /*     Hewlett-Packard Laboratories.                                     */
   4 /*                                                                       */
   5 /* Permission is hereby granted for unlimited modification, use, and     */
   6 /* distribution.  This software is made available with no warranty of    */
   7 /* any kind, express or implied.  This copyright notice must remain      */
   8 /* intact in all versions of this software.                              */
   9 /*                                                                       */
  10 /* The author would appreciate it if any bug fixes and enhancements were */
  11 /* to be sent back to him for incorporation into future versions of this */
  12 /* software.  Please send changes to tai@iag.hp.com or ken@sdd.hp.com.   */
  13 /*************************************************************************/
  14
  15 #ifndef lint
  16 static char RCSid[] = "adjtimed.c,v 3.1 1993/07/06 01:04:45 jbj Exp";
  17 #endif
  18
  19 /*
  20  * Adjust time daemon.
  21  * This daemon adjusts the rate of the system clock a la BSD's adjtime().
  22  * The adjtime() routine uses SYSV messages to communicate with this daemon.
  23  *
  24  * Caveat: This emulation uses an undocumented kernel variable.  As such, it
  25  * cannot be guaranteed to work in future HP-UX releases.  Fortunately,
  26  * it will no longer be needed in HPUX 10.01 and later.
  27  */
  28
  29 #include <sys/param.h>
  30 #include <sys/types.h>
  31 #include <sys/ipc.h>
  32 #include <sys/msg.h>
  33 #include <sys/lock.h>
  34 #include <time.h>
  35 #include <signal.h>
  36 #include <nlist.h>
  37 #include <fcntl.h>
  38 #include <stdio.h>
  39 #include <unistd.h>
  40
  41 #include "ntp_syslog.h"
  42 #include "ntp_stdlib.h"
  43
  44 #include "adjtime.h"
  45
  46 double atof (const char *);
  47
  48 int InitClockRate (void);
  49 int AdjustClockRate (register struct timeval *delta, register struct timeval *olddelta);
  50 long GetClockRate (void);
  51 int SetClockRate (long);
  52 void ResetClockRate (void);
  53 void Cleanup (void);
  54 void Exit (int);
  55
  56 #define MILLION         1000000L
  57
  58 /* emacs cc-mode goes nuts if we split the next line... */
  59 #define tvtod(tv)       ((double)tv.tv_sec + ((double)tv.tv_usec / (double)MILLION))
  60
  61 char *progname = NULL;
  62 int verbose = 0;
  63 int sysdebug = 0;
  64 static int mqid;
  65 static double oldrate = 0.0;
  66
  67 int
  68 main(
  69         int argc,
  70         char *argv[]
  71         )
  72 {
  73         struct timeval remains;
  74         struct sigvec vec;
  75         MsgBuf msg;
  76         char ch;
  77         int nofork = 0;
  78         int fd;
  79
  80         progname = argv[0];
  81
  82 #ifdef LOG_LOCAL6
  83         openlog("adjtimed", LOG_PID, LOG_LOCAL6);
  84 #else
  85         openlog("adjtimed", LOG_PID);
  86 #endif
  87
  88         while ((ch = ntp_getopt(argc, argv, "hkrvdfp:")) != EOF) {
  89                 switch (ch) {
  90                     case 'k':
  91                     case 'r':
  92                         if ((mqid = msgget(KEY, 0)) != -1) {
  93                                 if (msgctl(mqid, IPC_RMID, (struct msqid_ds *)0) == -1) {
  94                                         msyslog(LOG_ERR, "remove old message queue: %m");
  95                                         perror("adjtimed: remove old message queue");
  96                                         exit(1);
  97                                 }
  98                         }
  99
 100                         if (ch == 'k')
 101                             exit(0);
 102
 103                         break;
 104
 105                     case 'v':
 106                         ++verbose, nofork = 1;
 107                         break;
 108
 109                     case 'd':
 110                         ++sysdebug;
 111                         break;
 112
 113                     case 'f':
 114                         nofork = 1;
 115                         break;
 116
 117                     case 'p':
 118                         fputs("adjtimed: -p option ignored\n", stderr);
 119                         break;
 120
 121                     default:
 122                         puts("usage: adjtimed -hkrvdf");
 123                         puts("-h\thelp");
 124                         puts("-k\tkill existing adjtimed, if any");
 125                         puts("-r\trestart (kills existing adjtimed, if any)");
 126                         puts("-v\tdebug output (repeat for more output)");
 127                         puts("-d\tsyslog output (repeat for more output)");
 128                         puts("-f\tno fork");
 129                         msyslog(LOG_ERR, "usage error");
 130                         exit(1);
 131                 } /* switch */
 132         } /* while */
 133
 134         if (!nofork) {
 135                 switch (fork()) {
 136                     case 0:
 137                         close(fileno(stdin));
 138                         close(fileno(stdout));
 139                         close(fileno(stderr));
 140
 141 #ifdef TIOCNOTTY
 142                         if ((fd = open("/dev/tty")) != -1) {
 143                                 ioctl(fd, TIOCNOTTY, 0);
 144                                 close(fd);
 145                         }
 146 #else
 147                         setpgrp();
 148 #endif
 149                         break;
 150
 151                     case -1:
 152                         msyslog(LOG_ERR, "fork: %m");
 153                         perror("adjtimed: fork");
 154                         exit(1);
 155
 156                     default:
 157                         exit(0);
 158                 } /* switch */
 159         } /* if */
 160
 161         if (nofork) {
 162                 setvbuf(stdout, NULL, _IONBF, BUFSIZ);
 163                 setvbuf(stderr, NULL, _IONBF, BUFSIZ);
 164         }
 165
 166         msyslog(LOG_INFO, "started");
 167         if (verbose) printf("adjtimed: started\n");
 168
 169         if (InitClockRate() == -1)
 170             Exit(2);
 171
 172         (void)signal(SIGHUP, SIG_IGN);
 173         (void)signal(SIGINT, SIG_IGN);
 174         (void)signal(SIGQUIT, SIG_IGN);
 175         (void)signal(SIGTERM, Cleanup);
 176
 177         vec.sv_handler = ResetClockRate;
 178         vec.sv_flags = 0;
 179         vec.sv_mask = ~0;
 180         sigvector(SIGALRM, &vec, (struct sigvec *)0);
 181
 182         if (msgget(KEY, IPC_CREAT|IPC_EXCL) == -1) {
 183                 if (errno == EEXIST) {
 184                         msyslog(LOG_ERR, "message queue already exists, use -r to remove it");
 185                         fputs("adjtimed: message queue already exists, use -r to remove it\n",
 186                               stderr);
 187                         Exit(1);
 188                 }
 189
 190                 msyslog(LOG_ERR, "create message queue: %m");
 191                 perror("adjtimed: create message queue");
 192                 Exit(1);
 193         }
 194
 195         if ((mqid = msgget(KEY, 0)) == -1) {
 196                 msyslog(LOG_ERR, "get message queue id: %m");
 197                 perror("adjtimed: get message queue id");
 198                 Exit(1);
 199         }
 200
 201         /* Lock process in memory to improve response time */
 202         if (plock(PROCLOCK)) {
 203                 msyslog(LOG_ERR, "plock: %m");
 204                 perror("adjtimed: plock");
 205                 Cleanup();
 206         }
 207
 208         /* Also raise process priority.
 209          * If we do not get run when we want, this leads to bad timekeeping
 210          * and "Previous time adjustment didn't complete" gripes from xntpd.
 211          */
 212         if (nice(-10) == -1) {
 213                 msyslog(LOG_ERR, "nice: %m");
 214                 perror("adjtimed: nice");
 215                 Cleanup();
 216         }
 217
 218         for (;;) {
 219                 if (msgrcv(mqid, &msg.msgp, MSGSIZE, CLIENT, 0) == -1) {
 220                         if (errno == EINTR) continue;
 221                         msyslog(LOG_ERR, "read message: %m");
 222                         perror("adjtimed: read message");
 223                         Cleanup();
 224                 }
 225
 226                 switch (msg.msgb.code) {
 227                     case DELTA1:
 228                     case DELTA2:
 229                         AdjustClockRate(&msg.msgb.tv, &remains);
 230
 231                         if (msg.msgb.code == DELTA2) {
 232                                 msg.msgb.tv = remains;
 233                                 msg.msgb.mtype = SERVER;
 234
 235                                 while (msgsnd(mqid, &msg.msgp, MSGSIZE, 0) == -1) {
 236                                         if (errno == EINTR) continue;
 237                                         msyslog(LOG_ERR, "send message: %m");
 238                                         perror("adjtimed: send message");
 239                                         Cleanup();
 240                                 }
 241                         }
 242
 243                         if (remains.tv_sec + remains.tv_usec != 0L) {
 244                                 if (verbose) {
 245                                         printf("adjtimed: previous correction remaining %.6fs\n",
 246                                                tvtod(remains));
 247                                 }
 248                                 if (sysdebug) {
 249                                         msyslog(LOG_INFO, "previous correction remaining %.6fs",
 250                                                 tvtod(remains));
 251                                 }
 252                         }
 253                         break;
 254
 255                     default:
 256                         fprintf(stderr, "adjtimed: unknown message code %d\n", msg.msgb.code);
 257                         msyslog(LOG_ERR, "unknown message code %d", msg.msgb.code);
 258                 } /* switch */
 259         } /* loop */
 260 } /* main */
 261
 262 /*
 263  * Default clock rate (old_tick).
 264  */
 265 #define DEFAULT_RATE    (MILLION / HZ)
 266 #define UNKNOWN_RATE    0L
 267 #define TICK_ADJ        5       /* standard adjustment rate, microsec/tick */
 268
 269 static long default_rate = DEFAULT_RATE;
 270 static long tick_rate = HZ;     /* ticks per sec */
 271 static long slew_rate = TICK_ADJ * HZ; /* in microsec/sec */
 272
 273 int
 274 AdjustClockRate(
 275         register struct timeval *delta,
 276         register struct timeval *olddelta
 277         )
 278 {
 279         register long rate, dt, leftover;
 280         struct itimerval period, remains;
 281
 282         dt = (delta->tv_sec * MILLION) + delta->tv_usec;
 283
 284         if (verbose)
 285             printf("adjtimed: new correction %.6fs\n", (double)dt / (double)MILLION);
 286         if (sysdebug)
 287             msyslog(LOG_INFO, "new correction %.6fs", (double)dt / (double)MILLION);
 288         if (verbose > 2) printf("adjtimed: leftover %ldus\n", leftover);
 289         if (sysdebug > 2) msyslog(LOG_INFO, "leftover %ldus", leftover);
 290         rate = dt;
 291
 292         /*
 293          * Apply a slew rate of slew_rate over a period of dt/slew_rate seconds.
 294          */
 295         if (dt > 0) {
 296                 rate = slew_rate;
 297         } else {
 298                 rate = -slew_rate;
 299                 dt = -dt;
 300         }
 301         period.it_value.tv_sec = dt / slew_rate;
 302         period.it_value.tv_usec = (dt % slew_rate) * (MILLION / slew_rate);
 303         /*
 304          * Note: we assume the kernel will convert the specified period into ticks
 305          * using the modified clock rate rather than an assumed nominal clock rate,
 306          * and therefore will generate the timer interrupt after the specified
 307          * number of true seconds, not skewed seconds.
 308          */
 309
 310         if (verbose > 1)
 311             printf("adjtimed: will be complete in %lds %ldus\n",
 312                    period.it_value.tv_sec, period.it_value.tv_usec);
 313         if (sysdebug > 1)
 314             msyslog(LOG_INFO, "will be complete in %lds %ldus",
 315                     period.it_value.tv_sec, period.it_value.tv_usec);
 316         /*
 317          * adjust the clock rate
 318          */
 319         if (dt) {
 320                 if (SetClockRate((rate / tick_rate) + default_rate) == -1) {
 321                         msyslog(LOG_ERR, "set clock rate: %m");
 322                         perror("adjtimed: set clock rate");
 323                 }
 324         }
 325         /*
 326          * start the timer
 327          * (do this after changing the rate because the period has been rounded down)
 328          */
 329         period.it_interval.tv_sec = period.it_interval.tv_usec = 0L;
 330         setitimer(ITIMER_REAL, &period, &remains);
 331         /*
 332          * return old delta
 333          */
 334         if (olddelta) {
 335                 dt = ((remains.it_value.tv_sec * MILLION) + remains.it_value.tv_usec) *
 336                         oldrate;
 337                 olddelta->tv_sec = dt / MILLION;
 338                 olddelta->tv_usec = dt - (olddelta->tv_sec * MILLION);
 339         }
 340
 341         oldrate = (double)rate / (double)MILLION;
 342         return(0);
 343 } /* AdjustClockRate */
 344
 345 static struct nlist nl[] = {
 346 #ifdef __hp9000s800
 347 #ifdef PRE7_0
 348         { "tick" },
 349 #else
 350         { "old_tick" },
 351 #endif
 352 #else
 353         { "_old_tick" },
 354 #endif
 355         { "" }
 356 };
 357
 358 static int kmem;
 359
 360 /*
 361  * The return value is the clock rate in old_tick units or -1 if error.
 362  */
 363 long
 364 GetClockRate(void)
 365 {
 366         long rate, mask;
 367
 368         if (lseek(kmem, (off_t)nl[0].n_value, 0) == -1L)
 369             return (-1L);
 370
 371         mask = sigblock(sigmask(SIGALRM));
 372
 373         if (read(kmem, (caddr_t)&rate, sizeof(rate)) != sizeof(rate))
 374             rate = UNKNOWN_RATE;
 375
 376         sigsetmask(mask);
 377         return (rate);
 378 } /* GetClockRate */
 379
 380 /*
 381  * The argument is the new rate in old_tick units.
 382  */
 383 int
 384 SetClockRate(
 385         long rate
 386         )
 387 {
 388         long mask;
 389
 390         if (lseek(kmem, (off_t)nl[0].n_value, 0) == -1L)
 391             return (-1);
 392
 393         mask = sigblock(sigmask(SIGALRM));
 394
 395         if (write(kmem, (caddr_t)&rate, sizeof(rate)) != sizeof(rate)) {
 396                 sigsetmask(mask);
 397                 return (-1);
 398         }
 399
 400         sigsetmask(mask);
 401
 402         if (rate != default_rate) {
 403                 if (verbose > 3) {
 404                         printf("adjtimed: clock rate (%lu) %ldus/s\n", rate,
 405                                (rate - default_rate) * tick_rate);
 406                 }
 407                 if (sysdebug > 3) {
 408                         msyslog(LOG_INFO, "clock rate (%lu) %ldus/s", rate,
 409                                 (rate - default_rate) * tick_rate);
 410                 }
 411         }
 412
 413         return (0);
 414 } /* SetClockRate */
 415
 416 int
 417 InitClockRate(void)
 418 {
 419         if ((kmem = open("/dev/kmem", O_RDWR)) == -1) {
 420                 msyslog(LOG_ERR, "open(/dev/kmem): %m");
 421                 perror("adjtimed: open(/dev/kmem)");
 422                 return (-1);
 423         }
 424
 425         nlist("/hp-ux", nl);
 426
 427         if (nl[0].n_type == 0) {
 428                 fputs("adjtimed: /hp-ux has no symbol table\n", stderr);
 429                 msyslog(LOG_ERR, "/hp-ux has no symbol table");
 430                 return (-1);
 431         }
 432         /*
 433          * Set the default to the system's original value
 434          */
 435         default_rate = GetClockRate();
 436         if (default_rate == UNKNOWN_RATE) default_rate = DEFAULT_RATE;
 437         tick_rate = (MILLION / default_rate);
 438         slew_rate = TICK_ADJ * tick_rate;
 439         fprintf(stderr,"default_rate=%ld, tick_rate=%ld, slew_rate=%ld\n",default_rate,tick_rate,slew_rate);
 440
 441         return (0);
 442 } /* InitClockRate */
 443
 444 /*
 445  * Reset the clock rate to the default value.
 446  */
 447 void
 448 ResetClockRate(void)
 449 {
 450         struct itimerval it;
 451
 452         it.it_value.tv_sec = it.it_value.tv_usec = 0L;
 453         setitimer(ITIMER_REAL, &it, (struct itimerval *)0);
 454
 455         if (verbose > 2) puts("adjtimed: resetting the clock");
 456         if (sysdebug > 2) msyslog(LOG_INFO, "resetting the clock");
 457
 458         if (GetClockRate() != default_rate) {
 459                 if (SetClockRate(default_rate) == -1) {
 460                         msyslog(LOG_ERR, "set clock rate: %m");
 461                         perror("adjtimed: set clock rate");
 462                 }
 463         }
 464
 465         oldrate = 0.0;
 466 } /* ResetClockRate */
 467
 468 void
 469 Cleanup(void)
 470 {
 471         ResetClockRate();
 472
 473         if (msgctl(mqid, IPC_RMID, (struct msqid_ds *)0) == -1) {
 474                 if (errno != EINVAL) {
 475                         msyslog(LOG_ERR, "remove message queue: %m");
 476                         perror("adjtimed: remove message queue");
 477                 }
 478         }
 479
 480         Exit(2);
 481 } /* Cleanup */
 482
 483 void
 484 Exit(status)
 485      int status;
 486 {
 487         msyslog(LOG_ERR, "terminated");
 488         closelog();
 489         if (kmem != -1) close(kmem);
 490         exit(status);
 491 } /* Exit */