1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
|
/* ntpshmmon.c -- monitor the inner end of an ntpshmwrite.connection
*
* This file is Copyright (c) 2010 by the GPSD project
* BSD terms apply: see the file COPYING in the distribution root for details.
*
*/
#include <stdio.h>
#include <stdlib.h>
#include <getopt.h>
#include <limits.h>
#ifndef S_SPLINT_S
#include <unistd.h>
#endif /* S_SPLINT_S */
#include "gpsd_config.h"
#include "ntpshm.h"
#include "revision.h"
#define NTPSEGMENTS 256 /* NTPx for x any byte */
static struct shmTime *segments[NTPSEGMENTS + 1];
static struct timespec tick[NTPSEGMENTS + 1];
int main(int argc, char **argv)
{
int option;
int i;
bool killall = false;
bool verbose = false;
int nsamples = INT_MAX;
time_t timeout = (time_t)INT_MAX, starttime = time(NULL);
#define USAGE "usage: ntpshmmon [-s] [-n max] [-t timeout] [-v] [-h] [-V]\n"
while ((option = getopt(argc, argv, "hn:st:vV")) != -1) {
switch (option) {
case 'n':
nsamples = atoi(optarg);
break;
case 's':
killall = true;
break;
case 't':
timeout = (time_t)atoi(optarg);
break;
case 'v':
verbose = true;
break;
case 'V':
(void)fprintf(stderr, "%s: version %s (revision %s)\n",
argv[0], VERSION, REVISION);
exit(EXIT_SUCCESS);
case 'h':
default:
fprintf(stderr, USAGE);
break;
}
}
/* grab all segments, keep the non-null ones */
for (i = 0; i < NTPSEGMENTS; i++) {
segments[i] = shm_get(i, false, true);
if (verbose && segments[i] != NULL)
fprintf(stderr, "unit %d opened\n", i);
}
if (killall) {
struct shmTime **pp;
for (pp = segments; pp < segments + NTPSEGMENTS; pp++)
if (*pp != NULL)
(void)shmdt((void *)(*pp));
exit(EXIT_SUCCESS);
}
(void)printf("ntpshmmon version 1\n");
do {
struct shm_stat_t shm_stat;
for (i = 0; i < NTPSEGMENTS; i++) {
enum segstat_t status = ntp_read(segments[i], &shm_stat, false);
if (verbose)
fprintf(stderr, "unit %d status %d\n", i, status);
switch(status)
{
case OK:
/*@-mustfreefresh -formattype@*/
/*@-type@*//* splint is confused about struct timespec */
if (shm_stat.tvc.tv_sec != tick[i].tv_sec || shm_stat.tvc.tv_nsec != tick[i].tv_nsec) {
printf("sample %s %ld.%09ld %ld.%09ld %ld.%09ld %d %3d\n",
ntp_name(i),
(long)shm_stat.tvc.tv_sec, shm_stat.tvc.tv_nsec,
(long)shm_stat.tvr.tv_sec, shm_stat.tvr.tv_nsec,
(long)shm_stat.tvt.tv_sec, shm_stat.tvt.tv_nsec,
shm_stat.leap, shm_stat.precision);
tick[i] = shm_stat.tvc;
--nsamples;
}
/*@+type@*/
/*@+mustfreefresh +formattype@*/
break;
case NO_SEGMENT:
break;
case NOT_READY:
/* do nothing, data not ready, wait another cycle */
break;
case BAD_MODE:
/*@-mustfreefresh@*/
fprintf(stderr, "ntpshmmon: unknown mode %d on segment %s\n",
shm_stat.status, ntp_name(i));
/*@+mustfreefresh@*/
break;
case CLASH:
/* do nothing, data is corrupt, wait another cycle */
break;
default:
/*@-mustfreefresh@*/
fprintf(stderr, "ntpshmmon: unknown status %d on segment %s\n",
status, ntp_name(i));
/*@+mustfreefresh@*/
break;
}
}
/*
* Even on a 1 Hz PPS, a sleep(1) may end up
* being sleep(1.1) and missing a beat. Since
* we're ignoring duplicates via timestamp, polling
* at interval < 1 sec shouldn't be a problem.
*/
(void)usleep(1000);
} while
(nsamples != 0 && time(NULL) - starttime < timeout);
exit(EXIT_SUCCESS);
}
/* end */
|
