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 476eb54cbbSRichard Cochran static void show_flag_test(int rq_index, unsigned int flags, int err) 486eb54cbbSRichard Cochran { 496eb54cbbSRichard Cochran printf("PTP_EXTTS_REQUEST%c flags 0x%08x : (%d) %s\n", 506eb54cbbSRichard Cochran rq_index ? '1' + rq_index : ' ', 516eb54cbbSRichard Cochran flags, err, strerror(errno)); 526eb54cbbSRichard Cochran /* sigh, uClibc ... */ 536eb54cbbSRichard Cochran errno = 0; 546eb54cbbSRichard Cochran } 556eb54cbbSRichard Cochran 566eb54cbbSRichard Cochran static void do_flag_test(int fd, unsigned int index) 576eb54cbbSRichard Cochran { 586eb54cbbSRichard Cochran struct ptp_extts_request extts_request; 596eb54cbbSRichard Cochran unsigned long request[2] = { 606eb54cbbSRichard Cochran PTP_EXTTS_REQUEST, 616eb54cbbSRichard Cochran PTP_EXTTS_REQUEST2, 626eb54cbbSRichard Cochran }; 636eb54cbbSRichard Cochran unsigned int enable_flags[5] = { 646eb54cbbSRichard Cochran PTP_ENABLE_FEATURE, 656eb54cbbSRichard Cochran PTP_ENABLE_FEATURE | PTP_RISING_EDGE, 666eb54cbbSRichard Cochran PTP_ENABLE_FEATURE | PTP_FALLING_EDGE, 676eb54cbbSRichard Cochran PTP_ENABLE_FEATURE | PTP_RISING_EDGE | PTP_FALLING_EDGE, 686eb54cbbSRichard Cochran PTP_ENABLE_FEATURE | (PTP_EXTTS_VALID_FLAGS + 1), 696eb54cbbSRichard Cochran }; 706eb54cbbSRichard Cochran int err, i, j; 716eb54cbbSRichard Cochran 726eb54cbbSRichard Cochran memset(&extts_request, 0, sizeof(extts_request)); 736eb54cbbSRichard Cochran extts_request.index = index; 746eb54cbbSRichard Cochran 756eb54cbbSRichard Cochran for (i = 0; i < 2; i++) { 766eb54cbbSRichard Cochran for (j = 0; j < 5; j++) { 776eb54cbbSRichard Cochran extts_request.flags = enable_flags[j]; 786eb54cbbSRichard Cochran err = ioctl(fd, request[i], &extts_request); 796eb54cbbSRichard Cochran show_flag_test(i, extts_request.flags, err); 806eb54cbbSRichard Cochran 816eb54cbbSRichard Cochran extts_request.flags = 0; 826eb54cbbSRichard Cochran err = ioctl(fd, request[i], &extts_request); 836eb54cbbSRichard Cochran } 846eb54cbbSRichard Cochran } 856eb54cbbSRichard Cochran } 866eb54cbbSRichard Cochran 878dbbf854SShuah Khan static clockid_t get_clockid(int fd) 888dbbf854SShuah Khan { 898dbbf854SShuah Khan #define CLOCKFD 3 9029f1b2b0SNick Desaulniers return (((unsigned int) ~fd) << 3) | CLOCKFD; 918dbbf854SShuah Khan } 928dbbf854SShuah Khan 938dbbf854SShuah Khan static long ppb_to_scaled_ppm(int ppb) 948dbbf854SShuah Khan { 958dbbf854SShuah Khan /* 968dbbf854SShuah Khan * The 'freq' field in the 'struct timex' is in parts per 978dbbf854SShuah Khan * million, but with a 16 bit binary fractional field. 988dbbf854SShuah Khan * Instead of calculating either one of 998dbbf854SShuah Khan * 1008dbbf854SShuah Khan * scaled_ppm = (ppb / 1000) << 16 [1] 1018dbbf854SShuah Khan * scaled_ppm = (ppb << 16) / 1000 [2] 1028dbbf854SShuah Khan * 1038dbbf854SShuah Khan * we simply use double precision math, in order to avoid the 1048dbbf854SShuah Khan * truncation in [1] and the possible overflow in [2]. 1058dbbf854SShuah Khan */ 1068dbbf854SShuah Khan return (long) (ppb * 65.536); 1078dbbf854SShuah Khan } 1088dbbf854SShuah Khan 1098dbbf854SShuah Khan static int64_t pctns(struct ptp_clock_time *t) 1108dbbf854SShuah Khan { 1118dbbf854SShuah Khan return t->sec * 1000000000LL + t->nsec; 1128dbbf854SShuah Khan } 1138dbbf854SShuah Khan 1148dbbf854SShuah Khan static void usage(char *progname) 1158dbbf854SShuah Khan { 1168dbbf854SShuah Khan fprintf(stderr, 1178dbbf854SShuah Khan "usage: %s [options]\n" 1188dbbf854SShuah Khan " -c query the ptp clock's capabilities\n" 1198dbbf854SShuah Khan " -d name device to open\n" 1208dbbf854SShuah Khan " -e val read 'val' external time stamp events\n" 1218dbbf854SShuah Khan " -f val adjust the ptp clock frequency by 'val' ppb\n" 1228dbbf854SShuah Khan " -g get the ptp clock time\n" 1238dbbf854SShuah Khan " -h prints this message\n" 1248dbbf854SShuah Khan " -i val index for event/trigger\n" 1258dbbf854SShuah Khan " -k val measure the time offset between system and phc clock\n" 1268dbbf854SShuah Khan " for 'val' times (Maximum 25)\n" 1278dbbf854SShuah Khan " -l list the current pin configuration\n" 1288dbbf854SShuah Khan " -L pin,val configure pin index 'pin' with function 'val'\n" 1298dbbf854SShuah Khan " the channel index is taken from the '-i' option\n" 1308dbbf854SShuah Khan " 'val' specifies the auxiliary function:\n" 1318dbbf854SShuah Khan " 0 - none\n" 1328dbbf854SShuah Khan " 1 - external time stamp\n" 1338dbbf854SShuah Khan " 2 - periodic output\n" 1348dbbf854SShuah Khan " -p val enable output with a period of 'val' nanoseconds\n" 1358dbbf854SShuah Khan " -P val enable or disable (val=1|0) the system clock PPS\n" 1368dbbf854SShuah Khan " -s set the ptp clock time from the system time\n" 1378dbbf854SShuah Khan " -S set the system time from the ptp clock time\n" 1388dbbf854SShuah Khan " -t val shift the ptp clock time by 'val' seconds\n" 1396eb54cbbSRichard Cochran " -T val set the ptp clock time to 'val' seconds\n" 1406eb54cbbSRichard Cochran " -z test combinations of rising/falling external time stamp flags\n", 1418dbbf854SShuah Khan progname); 1428dbbf854SShuah Khan } 1438dbbf854SShuah Khan 1448dbbf854SShuah Khan int main(int argc, char *argv[]) 1458dbbf854SShuah Khan { 1468dbbf854SShuah Khan struct ptp_clock_caps caps; 1478dbbf854SShuah Khan struct ptp_extts_event event; 1488dbbf854SShuah Khan struct ptp_extts_request extts_request; 1498dbbf854SShuah Khan struct ptp_perout_request perout_request; 1508dbbf854SShuah Khan struct ptp_pin_desc desc; 1518dbbf854SShuah Khan struct timespec ts; 1528dbbf854SShuah Khan struct timex tx; 1538dbbf854SShuah Khan struct ptp_clock_time *pct; 1548dbbf854SShuah Khan struct ptp_sys_offset *sysoff; 1558dbbf854SShuah Khan 1568dbbf854SShuah Khan char *progname; 1578dbbf854SShuah Khan unsigned int i; 1588dbbf854SShuah Khan int c, cnt, fd; 1598dbbf854SShuah Khan 1608dbbf854SShuah Khan char *device = DEVICE; 1618dbbf854SShuah Khan clockid_t clkid; 1628dbbf854SShuah Khan int adjfreq = 0x7fffffff; 1638dbbf854SShuah Khan int adjtime = 0; 1648dbbf854SShuah Khan int capabilities = 0; 1658dbbf854SShuah Khan int extts = 0; 1666eb54cbbSRichard Cochran int flagtest = 0; 1678dbbf854SShuah Khan int gettime = 0; 1688dbbf854SShuah Khan int index = 0; 1698dbbf854SShuah Khan int list_pins = 0; 1708dbbf854SShuah Khan int pct_offset = 0; 1718dbbf854SShuah Khan int n_samples = 0; 1728dbbf854SShuah Khan int perout = -1; 1738dbbf854SShuah Khan int pin_index = -1, pin_func; 1748dbbf854SShuah Khan int pps = -1; 1758dbbf854SShuah Khan int seconds = 0; 1768dbbf854SShuah Khan int settime = 0; 1778dbbf854SShuah Khan 1788dbbf854SShuah Khan int64_t t1, t2, tp; 1798dbbf854SShuah Khan int64_t interval, offset; 1808dbbf854SShuah Khan 1818dbbf854SShuah Khan progname = strrchr(argv[0], '/'); 1828dbbf854SShuah Khan progname = progname ? 1+progname : argv[0]; 1836eb54cbbSRichard Cochran while (EOF != (c = getopt(argc, argv, "cd:e:f:ghi:k:lL:p:P:sSt:T:z"))) { 1848dbbf854SShuah Khan switch (c) { 1858dbbf854SShuah Khan case 'c': 1868dbbf854SShuah Khan capabilities = 1; 1878dbbf854SShuah Khan break; 1888dbbf854SShuah Khan case 'd': 1898dbbf854SShuah Khan device = optarg; 1908dbbf854SShuah Khan break; 1918dbbf854SShuah Khan case 'e': 1928dbbf854SShuah Khan extts = atoi(optarg); 1938dbbf854SShuah Khan break; 1948dbbf854SShuah Khan case 'f': 1958dbbf854SShuah Khan adjfreq = atoi(optarg); 1968dbbf854SShuah Khan break; 1978dbbf854SShuah Khan case 'g': 1988dbbf854SShuah Khan gettime = 1; 1998dbbf854SShuah Khan break; 2008dbbf854SShuah Khan case 'i': 2018dbbf854SShuah Khan index = atoi(optarg); 2028dbbf854SShuah Khan break; 2038dbbf854SShuah Khan case 'k': 2048dbbf854SShuah Khan pct_offset = 1; 2058dbbf854SShuah Khan n_samples = atoi(optarg); 2068dbbf854SShuah Khan break; 2078dbbf854SShuah Khan case 'l': 2088dbbf854SShuah Khan list_pins = 1; 2098dbbf854SShuah Khan break; 2108dbbf854SShuah Khan case 'L': 2118dbbf854SShuah Khan cnt = sscanf(optarg, "%d,%d", &pin_index, &pin_func); 2128dbbf854SShuah Khan if (cnt != 2) { 2138dbbf854SShuah Khan usage(progname); 2148dbbf854SShuah Khan return -1; 2158dbbf854SShuah Khan } 2168dbbf854SShuah Khan break; 2178dbbf854SShuah Khan case 'p': 2188dbbf854SShuah Khan perout = atoi(optarg); 2198dbbf854SShuah Khan break; 2208dbbf854SShuah Khan case 'P': 2218dbbf854SShuah Khan pps = atoi(optarg); 2228dbbf854SShuah Khan break; 2238dbbf854SShuah Khan case 's': 2248dbbf854SShuah Khan settime = 1; 2258dbbf854SShuah Khan break; 2268dbbf854SShuah Khan case 'S': 2278dbbf854SShuah Khan settime = 2; 2288dbbf854SShuah Khan break; 2298dbbf854SShuah Khan case 't': 2308dbbf854SShuah Khan adjtime = atoi(optarg); 2318dbbf854SShuah Khan break; 2328dbbf854SShuah Khan case 'T': 2338dbbf854SShuah Khan settime = 3; 2348dbbf854SShuah Khan seconds = atoi(optarg); 2358dbbf854SShuah Khan break; 2366eb54cbbSRichard Cochran case 'z': 2376eb54cbbSRichard Cochran flagtest = 1; 2386eb54cbbSRichard Cochran break; 2398dbbf854SShuah Khan case 'h': 2408dbbf854SShuah Khan usage(progname); 2418dbbf854SShuah Khan return 0; 2428dbbf854SShuah Khan case '?': 2438dbbf854SShuah Khan default: 2448dbbf854SShuah Khan usage(progname); 2458dbbf854SShuah Khan return -1; 2468dbbf854SShuah Khan } 2478dbbf854SShuah Khan } 2488dbbf854SShuah Khan 2498dbbf854SShuah Khan fd = open(device, O_RDWR); 2508dbbf854SShuah Khan if (fd < 0) { 2518dbbf854SShuah Khan fprintf(stderr, "opening %s: %s\n", device, strerror(errno)); 2528dbbf854SShuah Khan return -1; 2538dbbf854SShuah Khan } 2548dbbf854SShuah Khan 2558dbbf854SShuah Khan clkid = get_clockid(fd); 2568dbbf854SShuah Khan if (CLOCK_INVALID == clkid) { 2578dbbf854SShuah Khan fprintf(stderr, "failed to read clock id\n"); 2588dbbf854SShuah Khan return -1; 2598dbbf854SShuah Khan } 2608dbbf854SShuah Khan 2618dbbf854SShuah Khan if (capabilities) { 2628dbbf854SShuah Khan if (ioctl(fd, PTP_CLOCK_GETCAPS, &caps)) { 2638dbbf854SShuah Khan perror("PTP_CLOCK_GETCAPS"); 2648dbbf854SShuah Khan } else { 2658dbbf854SShuah Khan printf("capabilities:\n" 2668dbbf854SShuah Khan " %d maximum frequency adjustment (ppb)\n" 2678dbbf854SShuah Khan " %d programmable alarms\n" 2688dbbf854SShuah Khan " %d external time stamp channels\n" 2698dbbf854SShuah Khan " %d programmable periodic signals\n" 2708dbbf854SShuah Khan " %d pulse per second\n" 2718dbbf854SShuah Khan " %d programmable pins\n" 272*d3f1cbd2SVincent Cheng " %d cross timestamping\n" 273*d3f1cbd2SVincent Cheng " %d adjust_phase\n", 2748dbbf854SShuah Khan caps.max_adj, 2758dbbf854SShuah Khan caps.n_alarm, 2768dbbf854SShuah Khan caps.n_ext_ts, 2778dbbf854SShuah Khan caps.n_per_out, 2788dbbf854SShuah Khan caps.pps, 2798dbbf854SShuah Khan caps.n_pins, 280*d3f1cbd2SVincent Cheng caps.cross_timestamping, 281*d3f1cbd2SVincent Cheng caps.adjust_phase); 2828dbbf854SShuah Khan } 2838dbbf854SShuah Khan } 2848dbbf854SShuah Khan 2858dbbf854SShuah Khan if (0x7fffffff != adjfreq) { 2868dbbf854SShuah Khan memset(&tx, 0, sizeof(tx)); 2878dbbf854SShuah Khan tx.modes = ADJ_FREQUENCY; 2888dbbf854SShuah Khan tx.freq = ppb_to_scaled_ppm(adjfreq); 2898dbbf854SShuah Khan if (clock_adjtime(clkid, &tx)) { 2908dbbf854SShuah Khan perror("clock_adjtime"); 2918dbbf854SShuah Khan } else { 2928dbbf854SShuah Khan puts("frequency adjustment okay"); 2938dbbf854SShuah Khan } 2948dbbf854SShuah Khan } 2958dbbf854SShuah Khan 2968dbbf854SShuah Khan if (adjtime) { 2978dbbf854SShuah Khan memset(&tx, 0, sizeof(tx)); 2988dbbf854SShuah Khan tx.modes = ADJ_SETOFFSET; 2998dbbf854SShuah Khan tx.time.tv_sec = adjtime; 3008dbbf854SShuah Khan tx.time.tv_usec = 0; 3018dbbf854SShuah Khan if (clock_adjtime(clkid, &tx) < 0) { 3028dbbf854SShuah Khan perror("clock_adjtime"); 3038dbbf854SShuah Khan } else { 3048dbbf854SShuah Khan puts("time shift okay"); 3058dbbf854SShuah Khan } 3068dbbf854SShuah Khan } 3078dbbf854SShuah Khan 3088dbbf854SShuah Khan if (gettime) { 3098dbbf854SShuah Khan if (clock_gettime(clkid, &ts)) { 3108dbbf854SShuah Khan perror("clock_gettime"); 3118dbbf854SShuah Khan } else { 3128dbbf854SShuah Khan printf("clock time: %ld.%09ld or %s", 3138dbbf854SShuah Khan ts.tv_sec, ts.tv_nsec, ctime(&ts.tv_sec)); 3148dbbf854SShuah Khan } 3158dbbf854SShuah Khan } 3168dbbf854SShuah Khan 3178dbbf854SShuah Khan if (settime == 1) { 3188dbbf854SShuah Khan clock_gettime(CLOCK_REALTIME, &ts); 3198dbbf854SShuah Khan if (clock_settime(clkid, &ts)) { 3208dbbf854SShuah Khan perror("clock_settime"); 3218dbbf854SShuah Khan } else { 3228dbbf854SShuah Khan puts("set time okay"); 3238dbbf854SShuah Khan } 3248dbbf854SShuah Khan } 3258dbbf854SShuah Khan 3268dbbf854SShuah Khan if (settime == 2) { 3278dbbf854SShuah Khan clock_gettime(clkid, &ts); 3288dbbf854SShuah Khan if (clock_settime(CLOCK_REALTIME, &ts)) { 3298dbbf854SShuah Khan perror("clock_settime"); 3308dbbf854SShuah Khan } else { 3318dbbf854SShuah Khan puts("set time okay"); 3328dbbf854SShuah Khan } 3338dbbf854SShuah Khan } 3348dbbf854SShuah Khan 3358dbbf854SShuah Khan if (settime == 3) { 3368dbbf854SShuah Khan ts.tv_sec = seconds; 3378dbbf854SShuah Khan ts.tv_nsec = 0; 3388dbbf854SShuah Khan if (clock_settime(clkid, &ts)) { 3398dbbf854SShuah Khan perror("clock_settime"); 3408dbbf854SShuah Khan } else { 3418dbbf854SShuah Khan puts("set time okay"); 3428dbbf854SShuah Khan } 3438dbbf854SShuah Khan } 3448dbbf854SShuah Khan 3458dbbf854SShuah Khan if (extts) { 3468dbbf854SShuah Khan memset(&extts_request, 0, sizeof(extts_request)); 3478dbbf854SShuah Khan extts_request.index = index; 3488dbbf854SShuah Khan extts_request.flags = PTP_ENABLE_FEATURE; 3498dbbf854SShuah Khan if (ioctl(fd, PTP_EXTTS_REQUEST, &extts_request)) { 3508dbbf854SShuah Khan perror("PTP_EXTTS_REQUEST"); 3518dbbf854SShuah Khan extts = 0; 3528dbbf854SShuah Khan } else { 3538dbbf854SShuah Khan puts("external time stamp request okay"); 3548dbbf854SShuah Khan } 3558dbbf854SShuah Khan for (; extts; extts--) { 3568dbbf854SShuah Khan cnt = read(fd, &event, sizeof(event)); 3578dbbf854SShuah Khan if (cnt != sizeof(event)) { 3588dbbf854SShuah Khan perror("read"); 3598dbbf854SShuah Khan break; 3608dbbf854SShuah Khan } 3618dbbf854SShuah Khan printf("event index %u at %lld.%09u\n", event.index, 3628dbbf854SShuah Khan event.t.sec, event.t.nsec); 3638dbbf854SShuah Khan fflush(stdout); 3648dbbf854SShuah Khan } 3658dbbf854SShuah Khan /* Disable the feature again. */ 3668dbbf854SShuah Khan extts_request.flags = 0; 3678dbbf854SShuah Khan if (ioctl(fd, PTP_EXTTS_REQUEST, &extts_request)) { 3688dbbf854SShuah Khan perror("PTP_EXTTS_REQUEST"); 3698dbbf854SShuah Khan } 3708dbbf854SShuah Khan } 3718dbbf854SShuah Khan 3726eb54cbbSRichard Cochran if (flagtest) { 3736eb54cbbSRichard Cochran do_flag_test(fd, index); 3746eb54cbbSRichard Cochran } 3756eb54cbbSRichard Cochran 3768dbbf854SShuah Khan if (list_pins) { 3778dbbf854SShuah Khan int n_pins = 0; 3788dbbf854SShuah Khan if (ioctl(fd, PTP_CLOCK_GETCAPS, &caps)) { 3798dbbf854SShuah Khan perror("PTP_CLOCK_GETCAPS"); 3808dbbf854SShuah Khan } else { 3818dbbf854SShuah Khan n_pins = caps.n_pins; 3828dbbf854SShuah Khan } 3838dbbf854SShuah Khan for (i = 0; i < n_pins; i++) { 3848dbbf854SShuah Khan desc.index = i; 3858dbbf854SShuah Khan if (ioctl(fd, PTP_PIN_GETFUNC, &desc)) { 3868dbbf854SShuah Khan perror("PTP_PIN_GETFUNC"); 3878dbbf854SShuah Khan break; 3888dbbf854SShuah Khan } 3898dbbf854SShuah Khan printf("name %s index %u func %u chan %u\n", 3908dbbf854SShuah Khan desc.name, desc.index, desc.func, desc.chan); 3918dbbf854SShuah Khan } 3928dbbf854SShuah Khan } 3938dbbf854SShuah Khan 3948dbbf854SShuah Khan if (perout >= 0) { 3958dbbf854SShuah Khan if (clock_gettime(clkid, &ts)) { 3968dbbf854SShuah Khan perror("clock_gettime"); 3978dbbf854SShuah Khan return -1; 3988dbbf854SShuah Khan } 3998dbbf854SShuah Khan memset(&perout_request, 0, sizeof(perout_request)); 4008dbbf854SShuah Khan perout_request.index = index; 4018dbbf854SShuah Khan perout_request.start.sec = ts.tv_sec + 2; 4028dbbf854SShuah Khan perout_request.start.nsec = 0; 4038dbbf854SShuah Khan perout_request.period.sec = 0; 4048dbbf854SShuah Khan perout_request.period.nsec = perout; 4058dbbf854SShuah Khan if (ioctl(fd, PTP_PEROUT_REQUEST, &perout_request)) { 4068dbbf854SShuah Khan perror("PTP_PEROUT_REQUEST"); 4078dbbf854SShuah Khan } else { 4088dbbf854SShuah Khan puts("periodic output request okay"); 4098dbbf854SShuah Khan } 4108dbbf854SShuah Khan } 4118dbbf854SShuah Khan 4128dbbf854SShuah Khan if (pin_index >= 0) { 4138dbbf854SShuah Khan memset(&desc, 0, sizeof(desc)); 4148dbbf854SShuah Khan desc.index = pin_index; 4158dbbf854SShuah Khan desc.func = pin_func; 4168dbbf854SShuah Khan desc.chan = index; 4178dbbf854SShuah Khan if (ioctl(fd, PTP_PIN_SETFUNC, &desc)) { 4188dbbf854SShuah Khan perror("PTP_PIN_SETFUNC"); 4198dbbf854SShuah Khan } else { 4208dbbf854SShuah Khan puts("set pin function okay"); 4218dbbf854SShuah Khan } 4228dbbf854SShuah Khan } 4238dbbf854SShuah Khan 4248dbbf854SShuah Khan if (pps != -1) { 4258dbbf854SShuah Khan int enable = pps ? 1 : 0; 4268dbbf854SShuah Khan if (ioctl(fd, PTP_ENABLE_PPS, enable)) { 4278dbbf854SShuah Khan perror("PTP_ENABLE_PPS"); 4288dbbf854SShuah Khan } else { 4298dbbf854SShuah Khan puts("pps for system time request okay"); 4308dbbf854SShuah Khan } 4318dbbf854SShuah Khan } 4328dbbf854SShuah Khan 4338dbbf854SShuah Khan if (pct_offset) { 4348dbbf854SShuah Khan if (n_samples <= 0 || n_samples > 25) { 4358dbbf854SShuah Khan puts("n_samples should be between 1 and 25"); 4368dbbf854SShuah Khan usage(progname); 4378dbbf854SShuah Khan return -1; 4388dbbf854SShuah Khan } 4398dbbf854SShuah Khan 4408dbbf854SShuah Khan sysoff = calloc(1, sizeof(*sysoff)); 4418dbbf854SShuah Khan if (!sysoff) { 4428dbbf854SShuah Khan perror("calloc"); 4438dbbf854SShuah Khan return -1; 4448dbbf854SShuah Khan } 4458dbbf854SShuah Khan sysoff->n_samples = n_samples; 4468dbbf854SShuah Khan 4478dbbf854SShuah Khan if (ioctl(fd, PTP_SYS_OFFSET, sysoff)) 4488dbbf854SShuah Khan perror("PTP_SYS_OFFSET"); 4498dbbf854SShuah Khan else 4508dbbf854SShuah Khan puts("system and phc clock time offset request okay"); 4518dbbf854SShuah Khan 4528dbbf854SShuah Khan pct = &sysoff->ts[0]; 4538dbbf854SShuah Khan for (i = 0; i < sysoff->n_samples; i++) { 4548dbbf854SShuah Khan t1 = pctns(pct+2*i); 4558dbbf854SShuah Khan tp = pctns(pct+2*i+1); 4568dbbf854SShuah Khan t2 = pctns(pct+2*i+2); 4578dbbf854SShuah Khan interval = t2 - t1; 4588dbbf854SShuah Khan offset = (t2 + t1) / 2 - tp; 4598dbbf854SShuah Khan 4608dbbf854SShuah Khan printf("system time: %lld.%u\n", 4618dbbf854SShuah Khan (pct+2*i)->sec, (pct+2*i)->nsec); 4628dbbf854SShuah Khan printf("phc time: %lld.%u\n", 4638dbbf854SShuah Khan (pct+2*i+1)->sec, (pct+2*i+1)->nsec); 4648dbbf854SShuah Khan printf("system time: %lld.%u\n", 4658dbbf854SShuah Khan (pct+2*i+2)->sec, (pct+2*i+2)->nsec); 4668dbbf854SShuah Khan printf("system/phc clock time offset is %" PRId64 " ns\n" 4678dbbf854SShuah Khan "system clock time delay is %" PRId64 " ns\n", 4688dbbf854SShuah Khan offset, interval); 4698dbbf854SShuah Khan } 4708dbbf854SShuah Khan 4718dbbf854SShuah Khan free(sysoff); 4728dbbf854SShuah Khan } 4738dbbf854SShuah Khan 4748dbbf854SShuah Khan close(fd); 4758dbbf854SShuah Khan return 0; 4768dbbf854SShuah Khan } 477