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