Commit | Line | Data |
---|---|---|
b2441318 | 1 | // SPDX-License-Identifier: GPL-2.0 |
a4bcc795 BH |
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 | ||
3645c71b MM |
19 | #include "kselftest.h" |
20 | ||
a4bcc795 BH |
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 | }; | |
3645c71b | 55 | #define N_TX_TYPES ((int)(ARRAY_SIZE(tx_types))) |
a4bcc795 BH |
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 | }; | |
3645c71b | 76 | #define N_RX_FILTERS ((int)(ARRAY_SIZE(rx_filters))) |
a4bcc795 BH |
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 | } |