tools/testing/selftests/net/hwtstamp_config.c

   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 }