1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <stdio.h>
15#include <stdlib.h>
16#include <unistd.h>
17#include <fcntl.h>
18#include <sys/ioctl.h>
19#include <sys/socket.h>
20#include <netinet/in.h>
21#include <arpa/inet.h>
22#include <string.h>
23
24#include "utils.h"
25#include "tc_util.h"
26
27#define CLOCKID_INVALID (-1)
28static const struct static_clockid {
29 const char *name;
30 clockid_t clockid;
31} clockids_sysv[] = {
32 { "REALTIME", CLOCK_REALTIME },
33 { "TAI", CLOCK_TAI },
34 { "BOOTTIME", CLOCK_BOOTTIME },
35 { "MONOTONIC", CLOCK_MONOTONIC },
36 { NULL }
37};
38
39static void explain(void)
40{
41 fprintf(stderr,
42 "Usage: ... etf delta NANOS clockid CLOCKID [offload] [deadline_mode]\n"
43 "CLOCKID must be a valid SYS-V id (i.e. CLOCK_TAI)\n");
44}
45
46static void explain1(const char *arg, const char *val)
47{
48 fprintf(stderr, "etf: illegal value for \"%s\": \"%s\"\n", arg, val);
49}
50
51static void explain_clockid(const char *val)
52{
53 fprintf(stderr,
54 "etf: illegal value for \"clockid\": \"%s\".\n"
55 "It must be a valid SYS-V id (i.e. CLOCK_TAI)\n",
56 val);
57}
58
59static int get_clockid(__s32 *val, const char *arg)
60{
61 const struct static_clockid *c;
62
63
64 if (strcasestr(arg, "CLOCK_") != NULL)
65 arg += sizeof("CLOCK_") - 1;
66
67 for (c = clockids_sysv; c->name; c++) {
68 if (strcasecmp(c->name, arg) == 0) {
69 *val = c->clockid;
70
71 return 0;
72 }
73 }
74
75 return -1;
76}
77
78static const char* get_clock_name(clockid_t clockid)
79{
80 const struct static_clockid *c;
81
82 for (c = clockids_sysv; c->name; c++) {
83 if (clockid == c->clockid)
84 return c->name;
85 }
86
87 return "invalid";
88}
89
90static int etf_parse_opt(struct qdisc_util *qu, int argc,
91 char **argv, struct nlmsghdr *n, const char *dev)
92{
93 struct tc_etf_qopt opt = {
94 .clockid = CLOCKID_INVALID,
95 };
96 struct rtattr *tail;
97
98 while (argc > 0) {
99 if (matches(*argv, "offload") == 0) {
100 if (opt.flags & TC_ETF_OFFLOAD_ON) {
101 fprintf(stderr, "etf: duplicate \"offload\" specification\n");
102 return -1;
103 }
104
105 opt.flags |= TC_ETF_OFFLOAD_ON;
106 } else if (matches(*argv, "deadline_mode") == 0) {
107 if (opt.flags & TC_ETF_DEADLINE_MODE_ON) {
108 fprintf(stderr, "etf: duplicate \"deadline_mode\" specification\n");
109 return -1;
110 }
111
112 opt.flags |= TC_ETF_DEADLINE_MODE_ON;
113 } else if (matches(*argv, "delta") == 0) {
114 NEXT_ARG();
115 if (opt.delta) {
116 fprintf(stderr, "etf: duplicate \"delta\" specification\n");
117 return -1;
118 }
119 if (get_s32(&opt.delta, *argv, 0)) {
120 explain1("delta", *argv);
121 return -1;
122 }
123 } else if (matches(*argv, "clockid") == 0) {
124 NEXT_ARG();
125 if (opt.clockid != CLOCKID_INVALID) {
126 fprintf(stderr, "etf: duplicate \"clockid\" specification\n");
127 return -1;
128 }
129 if (get_clockid(&opt.clockid, *argv)) {
130 explain_clockid(*argv);
131 return -1;
132 }
133 } else if (strcmp(*argv, "skip_sock_check") == 0) {
134 if (opt.flags & TC_ETF_SKIP_SOCK_CHECK) {
135 fprintf(stderr, "etf: duplicate \"skip_sock_check\" specification\n");
136 return -1;
137 }
138
139 opt.flags |= TC_ETF_SKIP_SOCK_CHECK;
140 } else if (strcmp(*argv, "help") == 0) {
141 explain();
142 return -1;
143 } else {
144 fprintf(stderr, "etf: unknown parameter \"%s\"\n", *argv);
145 explain();
146 return -1;
147 }
148 argc--; argv++;
149 }
150
151 tail = NLMSG_TAIL(n);
152 addattr_l(n, 1024, TCA_OPTIONS, NULL, 0);
153 addattr_l(n, 2024, TCA_ETF_PARMS, &opt, sizeof(opt));
154 tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
155 return 0;
156}
157
158static int etf_print_opt(struct qdisc_util *qu, FILE *f, struct rtattr *opt)
159{
160 struct rtattr *tb[TCA_ETF_MAX+1];
161 struct tc_etf_qopt *qopt;
162
163 if (opt == NULL)
164 return 0;
165
166 parse_rtattr_nested(tb, TCA_ETF_MAX, opt);
167
168 if (tb[TCA_ETF_PARMS] == NULL)
169 return -1;
170
171 qopt = RTA_DATA(tb[TCA_ETF_PARMS]);
172 if (RTA_PAYLOAD(tb[TCA_ETF_PARMS]) < sizeof(*qopt))
173 return -1;
174
175 print_string(PRINT_ANY, "clockid", "clockid %s ",
176 get_clock_name(qopt->clockid));
177
178 print_uint(PRINT_ANY, "delta", "delta %d ", qopt->delta);
179 print_string(PRINT_ANY, "offload", "offload %s ",
180 (qopt->flags & TC_ETF_OFFLOAD_ON) ? "on" : "off");
181 print_string(PRINT_ANY, "deadline_mode", "deadline_mode %s ",
182 (qopt->flags & TC_ETF_DEADLINE_MODE_ON) ? "on" : "off");
183 print_string(PRINT_ANY, "skip_sock_check", "skip_sock_check %s",
184 (qopt->flags & TC_ETF_SKIP_SOCK_CHECK) ? "on" : "off");
185
186 return 0;
187}
188
189struct qdisc_util etf_qdisc_util = {
190 .id = "etf",
191 .parse_qopt = etf_parse_opt,
192 .print_qopt = etf_print_opt,
193};
194
