174ba9207SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 28dbbf854SShuah Khan /* 38dbbf854SShuah Khan * PTP 1588 clock support - User space test program 48dbbf854SShuah Khan * 58dbbf854SShuah Khan * Copyright (C) 2010 OMICRON electronics GmbH 68dbbf854SShuah Khan */ 78dbbf854SShuah Khan #define _GNU_SOURCE 88dbbf854SShuah Khan #define __SANE_USERSPACE_TYPES__ /* For PPC64, to get LL64 types */ 98dbbf854SShuah Khan #include <errno.h> 108dbbf854SShuah Khan #include <fcntl.h> 118dbbf854SShuah Khan #include <inttypes.h> 128dbbf854SShuah Khan #include <math.h> 138dbbf854SShuah Khan #include <signal.h> 148dbbf854SShuah Khan #include <stdio.h> 158dbbf854SShuah Khan #include <stdlib.h> 168dbbf854SShuah Khan #include <string.h> 178dbbf854SShuah Khan #include <sys/ioctl.h> 188dbbf854SShuah Khan #include <sys/mman.h> 198dbbf854SShuah Khan #include <sys/stat.h> 208dbbf854SShuah Khan #include <sys/time.h> 218dbbf854SShuah Khan #include <sys/timex.h> 228dbbf854SShuah Khan #include <sys/types.h> 238dbbf854SShuah Khan #include <time.h> 248dbbf854SShuah Khan #include <unistd.h> 258dbbf854SShuah Khan 268dbbf854SShuah Khan #include <linux/ptp_clock.h> 278dbbf854SShuah Khan 288dbbf854SShuah Khan #define DEVICE "/dev/ptp0" 298dbbf854SShuah Khan 308dbbf854SShuah Khan #ifndef ADJ_SETOFFSET 318dbbf854SShuah Khan #define ADJ_SETOFFSET 0x0100 328dbbf854SShuah Khan #endif 338dbbf854SShuah Khan 348dbbf854SShuah Khan #ifndef CLOCK_INVALID 358dbbf854SShuah Khan #define CLOCK_INVALID -1 368dbbf854SShuah Khan #endif 378dbbf854SShuah Khan 388dbbf854SShuah Khan /* clock_adjtime is not available in GLIBC < 2.14 */ 398dbbf854SShuah Khan #if !__GLIBC_PREREQ(2, 14) 408dbbf854SShuah Khan #include <sys/syscall.h> 418dbbf854SShuah Khan static int clock_adjtime(clockid_t id, struct timex *tx) 428dbbf854SShuah Khan { 438dbbf854SShuah Khan return syscall(__NR_clock_adjtime, id, tx); 448dbbf854SShuah Khan } 458dbbf854SShuah Khan #endif 468dbbf854SShuah Khan 478dbbf854SShuah Khan static clockid_t get_clockid(int fd) 488dbbf854SShuah Khan { 498dbbf854SShuah Khan #define CLOCKFD 3 5029f1b2b0SNick Desaulniers return (((unsigned int) ~fd) << 3) | CLOCKFD; 518dbbf854SShuah Khan } 528dbbf854SShuah Khan 538dbbf854SShuah Khan static void handle_alarm(int s) 548dbbf854SShuah Khan { 558dbbf854SShuah Khan printf("received signal %d\n", s); 568dbbf854SShuah Khan } 578dbbf854SShuah Khan 588dbbf854SShuah Khan static int install_handler(int signum, void (*handler)(int)) 598dbbf854SShuah Khan { 608dbbf854SShuah Khan struct sigaction action; 618dbbf854SShuah Khan sigset_t mask; 628dbbf854SShuah Khan 638dbbf854SShuah Khan /* Unblock the signal. */ 648dbbf854SShuah Khan sigemptyset(&mask); 658dbbf854SShuah Khan sigaddset(&mask, signum); 668dbbf854SShuah Khan sigprocmask(SIG_UNBLOCK, &mask, NULL); 678dbbf854SShuah Khan 688dbbf854SShuah Khan /* Install the signal handler. */ 698dbbf854SShuah Khan action.sa_handler = handler; 708dbbf854SShuah Khan action.sa_flags = 0; 718dbbf854SShuah Khan sigemptyset(&action.sa_mask); 728dbbf854SShuah Khan sigaction(signum, &action, NULL); 738dbbf854SShuah Khan 748dbbf854SShuah Khan return 0; 758dbbf854SShuah Khan } 768dbbf854SShuah Khan 778dbbf854SShuah Khan static long ppb_to_scaled_ppm(int ppb) 788dbbf854SShuah Khan { 798dbbf854SShuah Khan /* 808dbbf854SShuah Khan * The 'freq' field in the 'struct timex' is in parts per 818dbbf854SShuah Khan * million, but with a 16 bit binary fractional field. 828dbbf854SShuah Khan * Instead of calculating either one of 838dbbf854SShuah Khan * 848dbbf854SShuah Khan * scaled_ppm = (ppb / 1000) << 16 [1] 858dbbf854SShuah Khan * scaled_ppm = (ppb << 16) / 1000 [2] 868dbbf854SShuah Khan * 878dbbf854SShuah Khan * we simply use double precision math, in order to avoid the 888dbbf854SShuah Khan * truncation in [1] and the possible overflow in [2]. 898dbbf854SShuah Khan */ 908dbbf854SShuah Khan return (long) (ppb * 65.536); 918dbbf854SShuah Khan } 928dbbf854SShuah Khan 938dbbf854SShuah Khan static int64_t pctns(struct ptp_clock_time *t) 948dbbf854SShuah Khan { 958dbbf854SShuah Khan return t->sec * 1000000000LL + t->nsec; 968dbbf854SShuah Khan } 978dbbf854SShuah Khan 988dbbf854SShuah Khan static void usage(char *progname) 998dbbf854SShuah Khan { 1008dbbf854SShuah Khan fprintf(stderr, 1018dbbf854SShuah Khan "usage: %s [options]\n" 1028dbbf854SShuah Khan " -a val request a one-shot alarm after 'val' seconds\n" 1038dbbf854SShuah Khan " -A val request a periodic alarm every 'val' seconds\n" 1048dbbf854SShuah Khan " -c query the ptp clock's capabilities\n" 1058dbbf854SShuah Khan " -d name device to open\n" 1068dbbf854SShuah Khan " -e val read 'val' external time stamp events\n" 1078dbbf854SShuah Khan " -f val adjust the ptp clock frequency by 'val' ppb\n" 1088dbbf854SShuah Khan " -g get the ptp clock time\n" 1098dbbf854SShuah Khan " -h prints this message\n" 1108dbbf854SShuah Khan " -i val index for event/trigger\n" 1118dbbf854SShuah Khan " -k val measure the time offset between system and phc clock\n" 1128dbbf854SShuah Khan " for 'val' times (Maximum 25)\n" 1138dbbf854SShuah Khan " -l list the current pin configuration\n" 1148dbbf854SShuah Khan " -L pin,val configure pin index 'pin' with function 'val'\n" 1158dbbf854SShuah Khan " the channel index is taken from the '-i' option\n" 1168dbbf854SShuah Khan " 'val' specifies the auxiliary function:\n" 1178dbbf854SShuah Khan " 0 - none\n" 1188dbbf854SShuah Khan " 1 - external time stamp\n" 1198dbbf854SShuah Khan " 2 - periodic output\n" 1208dbbf854SShuah Khan " -p val enable output with a period of 'val' nanoseconds\n" 1218dbbf854SShuah Khan " -P val enable or disable (val=1|0) the system clock PPS\n" 1228dbbf854SShuah Khan " -s set the ptp clock time from the system time\n" 1238dbbf854SShuah Khan " -S set the system time from the ptp clock time\n" 1248dbbf854SShuah Khan " -t val shift the ptp clock time by 'val' seconds\n" 1258dbbf854SShuah Khan " -T val set the ptp clock time to 'val' seconds\n", 1268dbbf854SShuah Khan progname); 1278dbbf854SShuah Khan } 1288dbbf854SShuah Khan 1298dbbf854SShuah Khan int main(int argc, char *argv[]) 1308dbbf854SShuah Khan { 1318dbbf854SShuah Khan struct ptp_clock_caps caps; 1328dbbf854SShuah Khan struct ptp_extts_event event; 1338dbbf854SShuah Khan struct ptp_extts_request extts_request; 1348dbbf854SShuah Khan struct ptp_perout_request perout_request; 1358dbbf854SShuah Khan struct ptp_pin_desc desc; 1368dbbf854SShuah Khan struct timespec ts; 1378dbbf854SShuah Khan struct timex tx; 1388dbbf854SShuah Khan 1398dbbf854SShuah Khan static timer_t timerid; 1408dbbf854SShuah Khan struct itimerspec timeout; 1418dbbf854SShuah Khan struct sigevent sigevent; 1428dbbf854SShuah Khan 1438dbbf854SShuah Khan struct ptp_clock_time *pct; 1448dbbf854SShuah Khan struct ptp_sys_offset *sysoff; 1458dbbf854SShuah Khan 1468dbbf854SShuah Khan 1478dbbf854SShuah Khan char *progname; 1488dbbf854SShuah Khan unsigned int i; 1498dbbf854SShuah Khan int c, cnt, fd; 1508dbbf854SShuah Khan 1518dbbf854SShuah Khan char *device = DEVICE; 1528dbbf854SShuah Khan clockid_t clkid; 1538dbbf854SShuah Khan int adjfreq = 0x7fffffff; 1548dbbf854SShuah Khan int adjtime = 0; 1558dbbf854SShuah Khan int capabilities = 0; 1568dbbf854SShuah Khan int extts = 0; 1578dbbf854SShuah Khan int gettime = 0; 1588dbbf854SShuah Khan int index = 0; 1598dbbf854SShuah Khan int list_pins = 0; 1608dbbf854SShuah Khan int oneshot = 0; 1618dbbf854SShuah Khan int pct_offset = 0; 1628dbbf854SShuah Khan int n_samples = 0; 1638dbbf854SShuah Khan int periodic = 0; 1648dbbf854SShuah Khan int perout = -1; 1658dbbf854SShuah Khan int pin_index = -1, pin_func; 1668dbbf854SShuah Khan int pps = -1; 1678dbbf854SShuah Khan int seconds = 0; 1688dbbf854SShuah Khan int settime = 0; 1698dbbf854SShuah Khan 1708dbbf854SShuah Khan int64_t t1, t2, tp; 1718dbbf854SShuah Khan int64_t interval, offset; 1728dbbf854SShuah Khan 1738dbbf854SShuah Khan progname = strrchr(argv[0], '/'); 1748dbbf854SShuah Khan progname = progname ? 1+progname : argv[0]; 1758dbbf854SShuah Khan while (EOF != (c = getopt(argc, argv, "a:A:cd:e:f:ghi:k:lL:p:P:sSt:T:v"))) { 1768dbbf854SShuah Khan switch (c) { 1778dbbf854SShuah Khan case 'a': 1788dbbf854SShuah Khan oneshot = atoi(optarg); 1798dbbf854SShuah Khan break; 1808dbbf854SShuah Khan case 'A': 1818dbbf854SShuah Khan periodic = atoi(optarg); 1828dbbf854SShuah Khan break; 1838dbbf854SShuah Khan case 'c': 1848dbbf854SShuah Khan capabilities = 1; 1858dbbf854SShuah Khan break; 1868dbbf854SShuah Khan case 'd': 1878dbbf854SShuah Khan device = optarg; 1888dbbf854SShuah Khan break; 1898dbbf854SShuah Khan case 'e': 1908dbbf854SShuah Khan extts = atoi(optarg); 1918dbbf854SShuah Khan break; 1928dbbf854SShuah Khan case 'f': 1938dbbf854SShuah Khan adjfreq = atoi(optarg); 1948dbbf854SShuah Khan break; 1958dbbf854SShuah Khan case 'g': 1968dbbf854SShuah Khan gettime = 1; 1978dbbf854SShuah Khan break; 1988dbbf854SShuah Khan case 'i': 1998dbbf854SShuah Khan index = atoi(optarg); 2008dbbf854SShuah Khan break; 2018dbbf854SShuah Khan case 'k': 2028dbbf854SShuah Khan pct_offset = 1; 2038dbbf854SShuah Khan n_samples = atoi(optarg); 2048dbbf854SShuah Khan break; 2058dbbf854SShuah Khan case 'l': 2068dbbf854SShuah Khan list_pins = 1; 2078dbbf854SShuah Khan break; 2088dbbf854SShuah Khan case 'L': 2098dbbf854SShuah Khan cnt = sscanf(optarg, "%d,%d", &pin_index, &pin_func); 2108dbbf854SShuah Khan if (cnt != 2) { 2118dbbf854SShuah Khan usage(progname); 2128dbbf854SShuah Khan return -1; 2138dbbf854SShuah Khan } 2148dbbf854SShuah Khan break; 2158dbbf854SShuah Khan case 'p': 2168dbbf854SShuah Khan perout = atoi(optarg); 2178dbbf854SShuah Khan break; 2188dbbf854SShuah Khan case 'P': 2198dbbf854SShuah Khan pps = atoi(optarg); 2208dbbf854SShuah Khan break; 2218dbbf854SShuah Khan case 's': 2228dbbf854SShuah Khan settime = 1; 2238dbbf854SShuah Khan break; 2248dbbf854SShuah Khan case 'S': 2258dbbf854SShuah Khan settime = 2; 2268dbbf854SShuah Khan break; 2278dbbf854SShuah Khan case 't': 2288dbbf854SShuah Khan adjtime = atoi(optarg); 2298dbbf854SShuah Khan break; 2308dbbf854SShuah Khan case 'T': 2318dbbf854SShuah Khan settime = 3; 2328dbbf854SShuah Khan seconds = atoi(optarg); 2338dbbf854SShuah Khan break; 2348dbbf854SShuah Khan case 'h': 2358dbbf854SShuah Khan usage(progname); 2368dbbf854SShuah Khan return 0; 2378dbbf854SShuah Khan case '?': 2388dbbf854SShuah Khan default: 2398dbbf854SShuah Khan usage(progname); 2408dbbf854SShuah Khan return -1; 2418dbbf854SShuah Khan } 2428dbbf854SShuah Khan } 2438dbbf854SShuah Khan 2448dbbf854SShuah Khan fd = open(device, O_RDWR); 2458dbbf854SShuah Khan if (fd < 0) { 2468dbbf854SShuah Khan fprintf(stderr, "opening %s: %s\n", device, strerror(errno)); 2478dbbf854SShuah Khan return -1; 2488dbbf854SShuah Khan } 2498dbbf854SShuah Khan 2508dbbf854SShuah Khan clkid = get_clockid(fd); 2518dbbf854SShuah Khan if (CLOCK_INVALID == clkid) { 2528dbbf854SShuah Khan fprintf(stderr, "failed to read clock id\n"); 2538dbbf854SShuah Khan return -1; 2548dbbf854SShuah Khan } 2558dbbf854SShuah Khan 2568dbbf854SShuah Khan if (capabilities) { 2578dbbf854SShuah Khan if (ioctl(fd, PTP_CLOCK_GETCAPS, &caps)) { 2588dbbf854SShuah Khan perror("PTP_CLOCK_GETCAPS"); 2598dbbf854SShuah Khan } else { 2608dbbf854SShuah Khan printf("capabilities:\n" 2618dbbf854SShuah Khan " %d maximum frequency adjustment (ppb)\n" 2628dbbf854SShuah Khan " %d programmable alarms\n" 2638dbbf854SShuah Khan " %d external time stamp channels\n" 2648dbbf854SShuah Khan " %d programmable periodic signals\n" 2658dbbf854SShuah Khan " %d pulse per second\n" 2668dbbf854SShuah Khan " %d programmable pins\n" 2678dbbf854SShuah Khan " %d cross timestamping\n", 2688dbbf854SShuah Khan caps.max_adj, 2698dbbf854SShuah Khan caps.n_alarm, 2708dbbf854SShuah Khan caps.n_ext_ts, 2718dbbf854SShuah Khan caps.n_per_out, 2728dbbf854SShuah Khan caps.pps, 2738dbbf854SShuah Khan caps.n_pins, 2748dbbf854SShuah Khan caps.cross_timestamping); 2758dbbf854SShuah Khan } 2768dbbf854SShuah Khan } 2778dbbf854SShuah Khan 2788dbbf854SShuah Khan if (0x7fffffff != adjfreq) { 2798dbbf854SShuah Khan memset(&tx, 0, sizeof(tx)); 2808dbbf854SShuah Khan tx.modes = ADJ_FREQUENCY; 2818dbbf854SShuah Khan tx.freq = ppb_to_scaled_ppm(adjfreq); 2828dbbf854SShuah Khan if (clock_adjtime(clkid, &tx)) { 2838dbbf854SShuah Khan perror("clock_adjtime"); 2848dbbf854SShuah Khan } else { 2858dbbf854SShuah Khan puts("frequency adjustment okay"); 2868dbbf854SShuah Khan } 2878dbbf854SShuah Khan } 2888dbbf854SShuah Khan 2898dbbf854SShuah Khan if (adjtime) { 2908dbbf854SShuah Khan memset(&tx, 0, sizeof(tx)); 2918dbbf854SShuah Khan tx.modes = ADJ_SETOFFSET; 2928dbbf854SShuah Khan tx.time.tv_sec = adjtime; 2938dbbf854SShuah Khan tx.time.tv_usec = 0; 2948dbbf854SShuah Khan if (clock_adjtime(clkid, &tx) < 0) { 2958dbbf854SShuah Khan perror("clock_adjtime"); 2968dbbf854SShuah Khan } else { 2978dbbf854SShuah Khan puts("time shift okay"); 2988dbbf854SShuah Khan } 2998dbbf854SShuah Khan } 3008dbbf854SShuah Khan 3018dbbf854SShuah Khan if (gettime) { 3028dbbf854SShuah Khan if (clock_gettime(clkid, &ts)) { 3038dbbf854SShuah Khan perror("clock_gettime"); 3048dbbf854SShuah Khan } else { 3058dbbf854SShuah Khan printf("clock time: %ld.%09ld or %s", 3068dbbf854SShuah Khan ts.tv_sec, ts.tv_nsec, ctime(&ts.tv_sec)); 3078dbbf854SShuah Khan } 3088dbbf854SShuah Khan } 3098dbbf854SShuah Khan 3108dbbf854SShuah Khan if (settime == 1) { 3118dbbf854SShuah Khan clock_gettime(CLOCK_REALTIME, &ts); 3128dbbf854SShuah Khan if (clock_settime(clkid, &ts)) { 3138dbbf854SShuah Khan perror("clock_settime"); 3148dbbf854SShuah Khan } else { 3158dbbf854SShuah Khan puts("set time okay"); 3168dbbf854SShuah Khan } 3178dbbf854SShuah Khan } 3188dbbf854SShuah Khan 3198dbbf854SShuah Khan if (settime == 2) { 3208dbbf854SShuah Khan clock_gettime(clkid, &ts); 3218dbbf854SShuah Khan if (clock_settime(CLOCK_REALTIME, &ts)) { 3228dbbf854SShuah Khan perror("clock_settime"); 3238dbbf854SShuah Khan } else { 3248dbbf854SShuah Khan puts("set time okay"); 3258dbbf854SShuah Khan } 3268dbbf854SShuah Khan } 3278dbbf854SShuah Khan 3288dbbf854SShuah Khan if (settime == 3) { 3298dbbf854SShuah Khan ts.tv_sec = seconds; 3308dbbf854SShuah Khan ts.tv_nsec = 0; 3318dbbf854SShuah Khan if (clock_settime(clkid, &ts)) { 3328dbbf854SShuah Khan perror("clock_settime"); 3338dbbf854SShuah Khan } else { 3348dbbf854SShuah Khan puts("set time okay"); 3358dbbf854SShuah Khan } 3368dbbf854SShuah Khan } 3378dbbf854SShuah Khan 3388dbbf854SShuah Khan if (extts) { 3398dbbf854SShuah Khan memset(&extts_request, 0, sizeof(extts_request)); 3408dbbf854SShuah Khan extts_request.index = index; 3418dbbf854SShuah Khan extts_request.flags = PTP_ENABLE_FEATURE; 3428dbbf854SShuah Khan if (ioctl(fd, PTP_EXTTS_REQUEST, &extts_request)) { 3438dbbf854SShuah Khan perror("PTP_EXTTS_REQUEST"); 3448dbbf854SShuah Khan extts = 0; 3458dbbf854SShuah Khan } else { 3468dbbf854SShuah Khan puts("external time stamp request okay"); 3478dbbf854SShuah Khan } 3488dbbf854SShuah Khan for (; extts; extts--) { 3498dbbf854SShuah Khan cnt = read(fd, &event, sizeof(event)); 3508dbbf854SShuah Khan if (cnt != sizeof(event)) { 3518dbbf854SShuah Khan perror("read"); 3528dbbf854SShuah Khan break; 3538dbbf854SShuah Khan } 3548dbbf854SShuah Khan printf("event index %u at %lld.%09u\n", event.index, 3558dbbf854SShuah Khan event.t.sec, event.t.nsec); 3568dbbf854SShuah Khan fflush(stdout); 3578dbbf854SShuah Khan } 3588dbbf854SShuah Khan /* Disable the feature again. */ 3598dbbf854SShuah Khan extts_request.flags = 0; 3608dbbf854SShuah Khan if (ioctl(fd, PTP_EXTTS_REQUEST, &extts_request)) { 3618dbbf854SShuah Khan perror("PTP_EXTTS_REQUEST"); 3628dbbf854SShuah Khan } 3638dbbf854SShuah Khan } 3648dbbf854SShuah Khan 3658dbbf854SShuah Khan if (list_pins) { 3668dbbf854SShuah Khan int n_pins = 0; 3678dbbf854SShuah Khan if (ioctl(fd, PTP_CLOCK_GETCAPS, &caps)) { 3688dbbf854SShuah Khan perror("PTP_CLOCK_GETCAPS"); 3698dbbf854SShuah Khan } else { 3708dbbf854SShuah Khan n_pins = caps.n_pins; 3718dbbf854SShuah Khan } 3728dbbf854SShuah Khan for (i = 0; i < n_pins; i++) { 3738dbbf854SShuah Khan desc.index = i; 3748dbbf854SShuah Khan if (ioctl(fd, PTP_PIN_GETFUNC, &desc)) { 3758dbbf854SShuah Khan perror("PTP_PIN_GETFUNC"); 3768dbbf854SShuah Khan break; 3778dbbf854SShuah Khan } 3788dbbf854SShuah Khan printf("name %s index %u func %u chan %u\n", 3798dbbf854SShuah Khan desc.name, desc.index, desc.func, desc.chan); 3808dbbf854SShuah Khan } 3818dbbf854SShuah Khan } 3828dbbf854SShuah Khan 3838dbbf854SShuah Khan if (oneshot) { 3848dbbf854SShuah Khan install_handler(SIGALRM, handle_alarm); 3858dbbf854SShuah Khan /* Create a timer. */ 3868dbbf854SShuah Khan sigevent.sigev_notify = SIGEV_SIGNAL; 3878dbbf854SShuah Khan sigevent.sigev_signo = SIGALRM; 3888dbbf854SShuah Khan if (timer_create(clkid, &sigevent, &timerid)) { 3898dbbf854SShuah Khan perror("timer_create"); 3908dbbf854SShuah Khan return -1; 3918dbbf854SShuah Khan } 3928dbbf854SShuah Khan /* Start the timer. */ 3938dbbf854SShuah Khan memset(&timeout, 0, sizeof(timeout)); 3948dbbf854SShuah Khan timeout.it_value.tv_sec = oneshot; 3958dbbf854SShuah Khan if (timer_settime(timerid, 0, &timeout, NULL)) { 3968dbbf854SShuah Khan perror("timer_settime"); 3978dbbf854SShuah Khan return -1; 3988dbbf854SShuah Khan } 3998dbbf854SShuah Khan pause(); 4008dbbf854SShuah Khan timer_delete(timerid); 4018dbbf854SShuah Khan } 4028dbbf854SShuah Khan 4038dbbf854SShuah Khan if (periodic) { 4048dbbf854SShuah Khan install_handler(SIGALRM, handle_alarm); 4058dbbf854SShuah Khan /* Create a timer. */ 4068dbbf854SShuah Khan sigevent.sigev_notify = SIGEV_SIGNAL; 4078dbbf854SShuah Khan sigevent.sigev_signo = SIGALRM; 4088dbbf854SShuah Khan if (timer_create(clkid, &sigevent, &timerid)) { 4098dbbf854SShuah Khan perror("timer_create"); 4108dbbf854SShuah Khan return -1; 4118dbbf854SShuah Khan } 4128dbbf854SShuah Khan /* Start the timer. */ 4138dbbf854SShuah Khan memset(&timeout, 0, sizeof(timeout)); 4148dbbf854SShuah Khan timeout.it_interval.tv_sec = periodic; 4158dbbf854SShuah Khan timeout.it_value.tv_sec = periodic; 4168dbbf854SShuah Khan if (timer_settime(timerid, 0, &timeout, NULL)) { 4178dbbf854SShuah Khan perror("timer_settime"); 4188dbbf854SShuah Khan return -1; 4198dbbf854SShuah Khan } 4208dbbf854SShuah Khan while (1) { 4218dbbf854SShuah Khan pause(); 4228dbbf854SShuah Khan } 4238dbbf854SShuah Khan timer_delete(timerid); 4248dbbf854SShuah Khan } 4258dbbf854SShuah Khan 4268dbbf854SShuah Khan if (perout >= 0) { 4278dbbf854SShuah Khan if (clock_gettime(clkid, &ts)) { 4288dbbf854SShuah Khan perror("clock_gettime"); 4298dbbf854SShuah Khan return -1; 4308dbbf854SShuah Khan } 4318dbbf854SShuah Khan memset(&perout_request, 0, sizeof(perout_request)); 4328dbbf854SShuah Khan perout_request.index = index; 4338dbbf854SShuah Khan perout_request.start.sec = ts.tv_sec + 2; 4348dbbf854SShuah Khan perout_request.start.nsec = 0; 4358dbbf854SShuah Khan perout_request.period.sec = 0; 4368dbbf854SShuah Khan perout_request.period.nsec = perout; 4378dbbf854SShuah Khan if (ioctl(fd, PTP_PEROUT_REQUEST, &perout_request)) { 4388dbbf854SShuah Khan perror("PTP_PEROUT_REQUEST"); 4398dbbf854SShuah Khan } else { 4408dbbf854SShuah Khan puts("periodic output request okay"); 4418dbbf854SShuah Khan } 4428dbbf854SShuah Khan } 4438dbbf854SShuah Khan 4448dbbf854SShuah Khan if (pin_index >= 0) { 4458dbbf854SShuah Khan memset(&desc, 0, sizeof(desc)); 4468dbbf854SShuah Khan desc.index = pin_index; 4478dbbf854SShuah Khan desc.func = pin_func; 4488dbbf854SShuah Khan desc.chan = index; 4498dbbf854SShuah Khan if (ioctl(fd, PTP_PIN_SETFUNC, &desc)) { 4508dbbf854SShuah Khan perror("PTP_PIN_SETFUNC"); 4518dbbf854SShuah Khan } else { 4528dbbf854SShuah Khan puts("set pin function okay"); 4538dbbf854SShuah Khan } 4548dbbf854SShuah Khan } 4558dbbf854SShuah Khan 4568dbbf854SShuah Khan if (pps != -1) { 4578dbbf854SShuah Khan int enable = pps ? 1 : 0; 4588dbbf854SShuah Khan if (ioctl(fd, PTP_ENABLE_PPS, enable)) { 4598dbbf854SShuah Khan perror("PTP_ENABLE_PPS"); 4608dbbf854SShuah Khan } else { 4618dbbf854SShuah Khan puts("pps for system time request okay"); 4628dbbf854SShuah Khan } 4638dbbf854SShuah Khan } 4648dbbf854SShuah Khan 4658dbbf854SShuah Khan if (pct_offset) { 4668dbbf854SShuah Khan if (n_samples <= 0 || n_samples > 25) { 4678dbbf854SShuah Khan puts("n_samples should be between 1 and 25"); 4688dbbf854SShuah Khan usage(progname); 4698dbbf854SShuah Khan return -1; 4708dbbf854SShuah Khan } 4718dbbf854SShuah Khan 4728dbbf854SShuah Khan sysoff = calloc(1, sizeof(*sysoff)); 4738dbbf854SShuah Khan if (!sysoff) { 4748dbbf854SShuah Khan perror("calloc"); 4758dbbf854SShuah Khan return -1; 4768dbbf854SShuah Khan } 4778dbbf854SShuah Khan sysoff->n_samples = n_samples; 4788dbbf854SShuah Khan 4798dbbf854SShuah Khan if (ioctl(fd, PTP_SYS_OFFSET, sysoff)) 4808dbbf854SShuah Khan perror("PTP_SYS_OFFSET"); 4818dbbf854SShuah Khan else 4828dbbf854SShuah Khan puts("system and phc clock time offset request okay"); 4838dbbf854SShuah Khan 4848dbbf854SShuah Khan pct = &sysoff->ts[0]; 4858dbbf854SShuah Khan for (i = 0; i < sysoff->n_samples; i++) { 4868dbbf854SShuah Khan t1 = pctns(pct+2*i); 4878dbbf854SShuah Khan tp = pctns(pct+2*i+1); 4888dbbf854SShuah Khan t2 = pctns(pct+2*i+2); 4898dbbf854SShuah Khan interval = t2 - t1; 4908dbbf854SShuah Khan offset = (t2 + t1) / 2 - tp; 4918dbbf854SShuah Khan 4928dbbf854SShuah Khan printf("system time: %lld.%u\n", 4938dbbf854SShuah Khan (pct+2*i)->sec, (pct+2*i)->nsec); 4948dbbf854SShuah Khan printf("phc time: %lld.%u\n", 4958dbbf854SShuah Khan (pct+2*i+1)->sec, (pct+2*i+1)->nsec); 4968dbbf854SShuah Khan printf("system time: %lld.%u\n", 4978dbbf854SShuah Khan (pct+2*i+2)->sec, (pct+2*i+2)->nsec); 4988dbbf854SShuah Khan printf("system/phc clock time offset is %" PRId64 " ns\n" 4998dbbf854SShuah Khan "system clock time delay is %" PRId64 " ns\n", 5008dbbf854SShuah Khan offset, interval); 5018dbbf854SShuah Khan } 5028dbbf854SShuah Khan 5038dbbf854SShuah Khan free(sysoff); 5048dbbf854SShuah Khan } 5058dbbf854SShuah Khan 5068dbbf854SShuah Khan close(fd); 5078dbbf854SShuah Khan return 0; 5088dbbf854SShuah Khan } 509