phc2sys: add options for number of PHC readings and update rate

master
Miroslav Lichvar 2012-08-30 19:44:38 +02:00 committed by Richard Cochran
parent bf21c7c6a9
commit 6330764538
1 changed files with 14 additions and 8 deletions

View File

@ -41,8 +41,6 @@
#define max_ppb 512000 #define max_ppb 512000
#define min_ppb -512000 #define min_ppb -512000
#define PHC_READINGS 5
static clockid_t clock_open(char *device) static clockid_t clock_open(char *device)
{ {
int fd = open(device, O_RDWR); int fd = open(device, O_RDWR);
@ -87,7 +85,7 @@ static void clock_step(clockid_t clkid, int64_t ns)
fprintf(stderr, "failed to step clock: %m\n"); fprintf(stderr, "failed to step clock: %m\n");
} }
static int read_phc(clockid_t clkid, clockid_t sysclk, int rdelay, int64_t *offset, uint64_t *ts) static int read_phc(clockid_t clkid, clockid_t sysclk, int rdelay, int readings, int64_t *offset, uint64_t *ts)
{ {
struct timespec tdst1, tdst2, tsrc; struct timespec tdst1, tdst2, tsrc;
int i; int i;
@ -98,7 +96,7 @@ static int read_phc(clockid_t clkid, clockid_t sysclk, int rdelay, int64_t *offs
} }
/* Pick the quickest clkid reading. */ /* Pick the quickest clkid reading. */
for (i = 0; i < PHC_READINGS; i++) { for (i = 0; i < readings; i++) {
if (clock_gettime(sysclk, &tdst1) || if (clock_gettime(sysclk, &tdst1) ||
clock_gettime(clkid, &tsrc) || clock_gettime(clkid, &tsrc) ||
clock_gettime(sysclk, &tdst2)) { clock_gettime(sysclk, &tdst2)) {
@ -210,6 +208,8 @@ static void usage(char *progname)
" -s [device] set the time from this PHC device\n" " -s [device] set the time from this PHC device\n"
" -P [val] set proportional constant to 'val'\n" " -P [val] set proportional constant to 'val'\n"
" -I [val] set integration constant to 'val'\n" " -I [val] set integration constant to 'val'\n"
" -R [val] set PHC update rate to 'val' Hz\n"
" -N [val] set number of PHC readings per update\n"
"\n", "\n",
progname); progname);
} }
@ -221,12 +221,12 @@ int main(int argc, char *argv[])
clockid_t src = CLOCK_INVALID, dst = CLOCK_REALTIME; clockid_t src = CLOCK_INVALID, dst = CLOCK_REALTIME;
uint64_t pps_ts, phc_ts; uint64_t pps_ts, phc_ts;
int64_t pps_offset, phc_offset; int64_t pps_offset, phc_offset;
int c, fd = 0, rdelay = 0; int c, fd = 0, rdelay = 0, phc_readings = 5, phc_rate = 1;
/* Process the command line arguments. */ /* Process the command line arguments. */
progname = strrchr(argv[0], '/'); progname = strrchr(argv[0], '/');
progname = progname ? 1+progname : argv[0]; progname = progname ? 1+progname : argv[0];
while (EOF != (c = getopt(argc, argv, "c:d:hr:s:P:I:"))) { while (EOF != (c = getopt(argc, argv, "c:d:hr:s:P:I:R:N:"))) {
switch (c) { switch (c) {
case 'c': case 'c':
dst = clock_open(optarg); dst = clock_open(optarg);
@ -246,6 +246,12 @@ int main(int argc, char *argv[])
case 'I': case 'I':
ki = atof(optarg); ki = atof(optarg);
break; break;
case 'R':
phc_rate = atoi(optarg);
break;
case 'N':
phc_readings = atoi(optarg);
break;
case 'h': case 'h':
usage(progname); usage(progname);
return 0; return 0;
@ -279,9 +285,9 @@ int main(int argc, char *argv[])
continue; continue;
printf("pps %9lld ", pps_offset); printf("pps %9lld ", pps_offset);
} else } else
usleep(1000000); usleep(1000000 / phc_rate);
if (!read_phc(src, dst, rdelay, &phc_offset, &phc_ts)) if (!read_phc(src, dst, rdelay, phc_readings, &phc_offset, &phc_ts))
continue; continue;
printf("phc %9lld ", phc_offset); printf("phc %9lld ", phc_offset);