1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /* Test program for SIOC{G,S}HWTSTAMP
3*4882a593Smuzhiyun * Copyright 2013 Solarflare Communications
4*4882a593Smuzhiyun * Author: Ben Hutchings
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <errno.h>
8*4882a593Smuzhiyun #include <stdio.h>
9*4882a593Smuzhiyun #include <stdlib.h>
10*4882a593Smuzhiyun #include <string.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include <sys/socket.h>
13*4882a593Smuzhiyun #include <sys/ioctl.h>
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun #include <linux/if.h>
16*4882a593Smuzhiyun #include <linux/net_tstamp.h>
17*4882a593Smuzhiyun #include <linux/sockios.h>
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun static int
lookup_value(const char ** names,int size,const char * name)20*4882a593Smuzhiyun lookup_value(const char **names, int size, const char *name)
21*4882a593Smuzhiyun {
22*4882a593Smuzhiyun int value;
23*4882a593Smuzhiyun
24*4882a593Smuzhiyun for (value = 0; value < size; value++)
25*4882a593Smuzhiyun if (names[value] && strcasecmp(names[value], name) == 0)
26*4882a593Smuzhiyun return value;
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun return -1;
29*4882a593Smuzhiyun }
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun static const char *
lookup_name(const char ** names,int size,int value)32*4882a593Smuzhiyun lookup_name(const char **names, int size, int value)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun return (value >= 0 && value < size) ? names[value] : NULL;
35*4882a593Smuzhiyun }
36*4882a593Smuzhiyun
list_names(FILE * f,const char ** names,int size)37*4882a593Smuzhiyun static void list_names(FILE *f, const char **names, int size)
38*4882a593Smuzhiyun {
39*4882a593Smuzhiyun int value;
40*4882a593Smuzhiyun
41*4882a593Smuzhiyun for (value = 0; value < size; value++)
42*4882a593Smuzhiyun if (names[value])
43*4882a593Smuzhiyun fprintf(f, " %s\n", names[value]);
44*4882a593Smuzhiyun }
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun static const char *tx_types[] = {
47*4882a593Smuzhiyun #define TX_TYPE(name) [HWTSTAMP_TX_ ## name] = #name
48*4882a593Smuzhiyun TX_TYPE(OFF),
49*4882a593Smuzhiyun TX_TYPE(ON),
50*4882a593Smuzhiyun TX_TYPE(ONESTEP_SYNC)
51*4882a593Smuzhiyun #undef TX_TYPE
52*4882a593Smuzhiyun };
53*4882a593Smuzhiyun #define N_TX_TYPES ((int)(sizeof(tx_types) / sizeof(tx_types[0])))
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun static const char *rx_filters[] = {
56*4882a593Smuzhiyun #define RX_FILTER(name) [HWTSTAMP_FILTER_ ## name] = #name
57*4882a593Smuzhiyun RX_FILTER(NONE),
58*4882a593Smuzhiyun RX_FILTER(ALL),
59*4882a593Smuzhiyun RX_FILTER(SOME),
60*4882a593Smuzhiyun RX_FILTER(PTP_V1_L4_EVENT),
61*4882a593Smuzhiyun RX_FILTER(PTP_V1_L4_SYNC),
62*4882a593Smuzhiyun RX_FILTER(PTP_V1_L4_DELAY_REQ),
63*4882a593Smuzhiyun RX_FILTER(PTP_V2_L4_EVENT),
64*4882a593Smuzhiyun RX_FILTER(PTP_V2_L4_SYNC),
65*4882a593Smuzhiyun RX_FILTER(PTP_V2_L4_DELAY_REQ),
66*4882a593Smuzhiyun RX_FILTER(PTP_V2_L2_EVENT),
67*4882a593Smuzhiyun RX_FILTER(PTP_V2_L2_SYNC),
68*4882a593Smuzhiyun RX_FILTER(PTP_V2_L2_DELAY_REQ),
69*4882a593Smuzhiyun RX_FILTER(PTP_V2_EVENT),
70*4882a593Smuzhiyun RX_FILTER(PTP_V2_SYNC),
71*4882a593Smuzhiyun RX_FILTER(PTP_V2_DELAY_REQ),
72*4882a593Smuzhiyun #undef RX_FILTER
73*4882a593Smuzhiyun };
74*4882a593Smuzhiyun #define N_RX_FILTERS ((int)(sizeof(rx_filters) / sizeof(rx_filters[0])))
75*4882a593Smuzhiyun
usage(void)76*4882a593Smuzhiyun static void usage(void)
77*4882a593Smuzhiyun {
78*4882a593Smuzhiyun fputs("Usage: hwtstamp_config if_name [tx_type rx_filter]\n"
79*4882a593Smuzhiyun "tx_type is any of (case-insensitive):\n",
80*4882a593Smuzhiyun stderr);
81*4882a593Smuzhiyun list_names(stderr, tx_types, N_TX_TYPES);
82*4882a593Smuzhiyun fputs("rx_filter is any of (case-insensitive):\n", stderr);
83*4882a593Smuzhiyun list_names(stderr, rx_filters, N_RX_FILTERS);
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun
main(int argc,char ** argv)86*4882a593Smuzhiyun int main(int argc, char **argv)
87*4882a593Smuzhiyun {
88*4882a593Smuzhiyun struct ifreq ifr;
89*4882a593Smuzhiyun struct hwtstamp_config config;
90*4882a593Smuzhiyun const char *name;
91*4882a593Smuzhiyun int sock;
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun if ((argc != 2 && argc != 4) || (strlen(argv[1]) >= IFNAMSIZ)) {
94*4882a593Smuzhiyun usage();
95*4882a593Smuzhiyun return 2;
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun if (argc == 4) {
99*4882a593Smuzhiyun config.flags = 0;
100*4882a593Smuzhiyun config.tx_type = lookup_value(tx_types, N_TX_TYPES, argv[2]);
101*4882a593Smuzhiyun config.rx_filter = lookup_value(rx_filters, N_RX_FILTERS, argv[3]);
102*4882a593Smuzhiyun if (config.tx_type < 0 || config.rx_filter < 0) {
103*4882a593Smuzhiyun usage();
104*4882a593Smuzhiyun return 2;
105*4882a593Smuzhiyun }
106*4882a593Smuzhiyun }
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun sock = socket(AF_INET, SOCK_DGRAM, 0);
109*4882a593Smuzhiyun if (sock < 0) {
110*4882a593Smuzhiyun perror("socket");
111*4882a593Smuzhiyun return 1;
112*4882a593Smuzhiyun }
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun strcpy(ifr.ifr_name, argv[1]);
115*4882a593Smuzhiyun ifr.ifr_data = (caddr_t)&config;
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun if (ioctl(sock, (argc == 2) ? SIOCGHWTSTAMP : SIOCSHWTSTAMP, &ifr)) {
118*4882a593Smuzhiyun perror("ioctl");
119*4882a593Smuzhiyun return 1;
120*4882a593Smuzhiyun }
121*4882a593Smuzhiyun
122*4882a593Smuzhiyun printf("flags = %#x\n", config.flags);
123*4882a593Smuzhiyun name = lookup_name(tx_types, N_TX_TYPES, config.tx_type);
124*4882a593Smuzhiyun if (name)
125*4882a593Smuzhiyun printf("tx_type = %s\n", name);
126*4882a593Smuzhiyun else
127*4882a593Smuzhiyun printf("tx_type = %d\n", config.tx_type);
128*4882a593Smuzhiyun name = lookup_name(rx_filters, N_RX_FILTERS, config.rx_filter);
129*4882a593Smuzhiyun if (name)
130*4882a593Smuzhiyun printf("rx_filter = %s\n", name);
131*4882a593Smuzhiyun else
132*4882a593Smuzhiyun printf("rx_filter = %d\n", config.rx_filter);
133*4882a593Smuzhiyun
134*4882a593Smuzhiyun return 0;
135*4882a593Smuzhiyun }
136