~ubuntu-branches/ubuntu/oneiric/ntp/oneiric

« back to all changes in this revision

Viewing changes to .pc/dfsg.patch/adjtimed/adjtimed.c

  • Committer: Bazaar Package Importer
  • Author(s): Jamie Strandboge
  • Date: 2010-04-08 16:24:42 UTC
  • mfrom: (34.4.5 lucid)
  • Revision ID: james.westby@ubuntu.com-20100408162442-we41i5fzehptyhvu
Tags: 1:4.2.4p8+dfsg-1ubuntu2
debian/apparmor-profile: allow reading of /var/lib/ntp/ntp.conf.dhcp
(LP: #517701)

Show diffs side-by-side

added added

removed removed

Lines of Context:
 
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 */