1 /*
2 * q_rsvp.c RSVP filter.
3 *
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
8 *
9 * Authors: Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
10 *
11 */
12
13 #include <stdio.h>
14 #include <stdlib.h>
15 #include <unistd.h>
16 #include <syslog.h>
17 #include <fcntl.h>
18 #include <sys/socket.h>
19 #include <netinet/in.h>
20 #include <arpa/inet.h>
21 #include <string.h>
22
23 #include "rt_names.h"
24 #include "utils.h"
25 #include "tc_util.h"
26
explain(void)27 static void explain(void)
28 {
29 fprintf(stderr, "Usage: ... rsvp ipproto PROTOCOL session DST[/PORT | GPI ]\n");
30 fprintf(stderr, " [ sender SRC[/PORT | GPI ]\n");
31 fprintf(stderr, " [ classid CLASSID ] [ police POLICE_SPEC ]\n");
32 fprintf(stderr, " [ tunnelid ID ] [ tunnel ID skip NUMBER ]\n");
33 fprintf(stderr, "Where: GPI := { flowlabel NUMBER | spi/ah SPI | spi/esp SPI |\n");
34 fprintf(stderr, " u{8|16|32} NUMBER mask MASK at OFFSET}\n");
35 fprintf(stderr, " POLICE_SPEC := ... look at TBF\n");
36 fprintf(stderr, " FILTERID := X:Y\n");
37 fprintf(stderr, "\nNOTE: CLASSID is parsed as hexadecimal input.\n");
38 }
39
get_addr_and_pi(int * argc_p,char *** argv_p,inet_prefix * addr,struct tc_rsvp_pinfo * pinfo,int dir,int family)40 int get_addr_and_pi(int *argc_p, char ***argv_p, inet_prefix * addr,
41 struct tc_rsvp_pinfo *pinfo, int dir, int family)
42 {
43 int argc = *argc_p;
44 char **argv = *argv_p;
45 char *p = strchr(*argv, '/');
46 struct tc_rsvp_gpi *pi = dir ? &pinfo->dpi : &pinfo->spi;
47
48 if (p) {
49 __u16 tmp;
50
51 if (get_u16(&tmp, p+1, 0))
52 return -1;
53
54 if (dir == 0) {
55 /* Source port: u16 at offset 0 */
56 pi->key = htonl(((__u32)tmp)<<16);
57 pi->mask = htonl(0xFFFF0000);
58 } else {
59 /* Destination port: u16 at offset 2 */
60 pi->key = htonl(((__u32)tmp));
61 pi->mask = htonl(0x0000FFFF);
62 }
63 pi->offset = 0;
64 *p = 0;
65 }
66 if (get_addr_1(addr, *argv, family))
67 return -1;
68 if (p)
69 *p = '/';
70
71 argc--; argv++;
72
73 if (pi->mask || argc <= 0)
74 goto done;
75
76 if (strcmp(*argv, "spi/ah") == 0 ||
77 strcmp(*argv, "gpi/ah") == 0) {
78 __u32 gpi;
79 NEXT_ARG();
80 if (get_u32(&gpi, *argv, 0))
81 return -1;
82 pi->mask = htonl(0xFFFFFFFF);
83 pi->key = htonl(gpi);
84 pi->offset = 4;
85 if (pinfo->protocol == 0)
86 pinfo->protocol = IPPROTO_AH;
87 argc--; argv++;
88 } else if (strcmp(*argv, "spi/esp") == 0 ||
89 strcmp(*argv, "gpi/esp") == 0) {
90 __u32 gpi;
91 NEXT_ARG();
92 if (get_u32(&gpi, *argv, 0))
93 return -1;
94 pi->mask = htonl(0xFFFFFFFF);
95 pi->key = htonl(gpi);
96 pi->offset = 0;
97 if (pinfo->protocol == 0)
98 pinfo->protocol = IPPROTO_ESP;
99 argc--; argv++;
100 } else if (strcmp(*argv, "flowlabel") == 0) {
101 __u32 flabel;
102 NEXT_ARG();
103 if (get_u32(&flabel, *argv, 0))
104 return -1;
105 if (family != AF_INET6)
106 return -1;
107 pi->mask = htonl(0x000FFFFF);
108 pi->key = htonl(flabel) & pi->mask;
109 pi->offset = -40;
110 argc--; argv++;
111 } else if (strcmp(*argv, "u32") == 0 ||
112 strcmp(*argv, "u16") == 0 ||
113 strcmp(*argv, "u8") == 0) {
114 int sz = 1;
115 __u32 tmp;
116 __u32 mask = 0xff;
117 if (strcmp(*argv, "u32") == 0) {
118 sz = 4;
119 mask = 0xffff;
120 } else if (strcmp(*argv, "u16") == 0) {
121 mask = 0xffffffff;
122 sz = 2;
123 }
124 NEXT_ARG();
125 if (get_u32(&tmp, *argv, 0))
126 return -1;
127 argc--; argv++;
128 if (strcmp(*argv, "mask") == 0) {
129 NEXT_ARG();
130 if (get_u32(&mask, *argv, 16))
131 return -1;
132 argc--; argv++;
133 }
134 if (strcmp(*argv, "at") == 0) {
135 NEXT_ARG();
136 if (get_integer(&pi->offset, *argv, 0))
137 return -1;
138 argc--; argv++;
139 }
140 if (sz == 1) {
141 if ((pi->offset & 3) == 0) {
142 mask <<= 24;
143 tmp <<= 24;
144 } else if ((pi->offset & 3) == 1) {
145 mask <<= 16;
146 tmp <<= 16;
147 } else if ((pi->offset & 3) == 3) {
148 mask <<= 8;
149 tmp <<= 8;
150 }
151 } else if (sz == 2) {
152 if ((pi->offset & 3) == 0) {
153 mask <<= 16;
154 tmp <<= 16;
155 }
156 }
157 pi->offset &= ~3;
158 pi->mask = htonl(mask);
159 pi->key = htonl(tmp) & pi->mask;
160 }
161
162 done:
163 *argc_p = argc;
164 *argv_p = argv;
165 return 0;
166 }
167
168
rsvp_parse_opt(struct filter_util * qu,char * handle,int argc,char ** argv,struct nlmsghdr * n)169 static int rsvp_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n)
170 {
171 int family = strcmp(qu->id, "rsvp") == 0 ? AF_INET : AF_INET6;
172 struct tc_rsvp_pinfo pinfo;
173 struct tc_police tp;
174 struct tcmsg *t = NLMSG_DATA(n);
175 int pinfo_ok = 0;
176 struct rtattr *tail;
177
178 memset(&pinfo, 0, sizeof(pinfo));
179 memset(&tp, 0, sizeof(tp));
180
181 if (handle) {
182 if (get_u32(&t->tcm_handle, handle, 0)) {
183 fprintf(stderr, "Illegal \"handle\"\n");
184 return -1;
185 }
186 }
187
188 if (argc == 0)
189 return 0;
190
191 tail = NLMSG_TAIL(n);
192 addattr_l(n, 4096, TCA_OPTIONS, NULL, 0);
193
194 while (argc > 0) {
195 if (matches(*argv, "session") == 0) {
196 inet_prefix addr;
197 NEXT_ARG();
198 if (get_addr_and_pi(&argc, &argv, &addr, &pinfo, 1, family)) {
199 fprintf(stderr, "Illegal \"session\"\n");
200 return -1;
201 }
202 addattr_l(n, 4096, TCA_RSVP_DST, &addr.data, addr.bytelen);
203 if (pinfo.dpi.mask || pinfo.protocol)
204 pinfo_ok++;
205 continue;
206 } else if (matches(*argv, "sender") == 0 ||
207 matches(*argv, "flowspec") == 0) {
208 inet_prefix addr;
209 NEXT_ARG();
210 if (get_addr_and_pi(&argc, &argv, &addr, &pinfo, 0, family)) {
211 fprintf(stderr, "Illegal \"sender\"\n");
212 return -1;
213 }
214 addattr_l(n, 4096, TCA_RSVP_SRC, &addr.data, addr.bytelen);
215 if (pinfo.spi.mask || pinfo.protocol)
216 pinfo_ok++;
217 continue;
218 } else if (matches("ipproto", *argv) == 0) {
219 int num;
220 NEXT_ARG();
221 num = inet_proto_a2n(*argv);
222 if (num < 0) {
223 fprintf(stderr, "Illegal \"ipproto\"\n");
224 return -1;
225 }
226 pinfo.protocol = num;
227 pinfo_ok++;
228 } else if (matches(*argv, "classid") == 0 ||
229 strcmp(*argv, "flowid") == 0) {
230 unsigned handle;
231 NEXT_ARG();
232 if (get_tc_classid(&handle, *argv)) {
233 fprintf(stderr, "Illegal \"classid\"\n");
234 return -1;
235 }
236 addattr_l(n, 4096, TCA_RSVP_CLASSID, &handle, 4);
237 } else if (strcmp(*argv, "tunnelid") == 0) {
238 unsigned tid;
239 NEXT_ARG();
240 if (get_unsigned(&tid, *argv, 0)) {
241 fprintf(stderr, "Illegal \"tunnelid\"\n");
242 return -1;
243 }
244 pinfo.tunnelid = tid;
245 pinfo_ok++;
246 } else if (strcmp(*argv, "tunnel") == 0) {
247 unsigned tid;
248 NEXT_ARG();
249 if (get_unsigned(&tid, *argv, 0)) {
250 fprintf(stderr, "Illegal \"tunnel\"\n");
251 return -1;
252 }
253 addattr_l(n, 4096, TCA_RSVP_CLASSID, &tid, 4);
254 NEXT_ARG();
255 if (strcmp(*argv, "skip") == 0) {
256 NEXT_ARG();
257 }
258 if (get_unsigned(&tid, *argv, 0)) {
259 fprintf(stderr, "Illegal \"skip\"\n");
260 return -1;
261 }
262 pinfo.tunnelhdr = tid;
263 pinfo_ok++;
264 } else if (matches(*argv, "police") == 0) {
265 NEXT_ARG();
266 if (parse_police(&argc, &argv, TCA_RSVP_POLICE, n)) {
267 fprintf(stderr, "Illegal \"police\"\n");
268 return -1;
269 }
270 continue;
271 } else if (strcmp(*argv, "help") == 0) {
272 explain();
273 return -1;
274 } else {
275 fprintf(stderr, "What is \"%s\"?\n", *argv);
276 explain();
277 return -1;
278 }
279 argc--; argv++;
280 }
281
282 if (pinfo_ok)
283 addattr_l(n, 4096, TCA_RSVP_PINFO, &pinfo, sizeof(pinfo));
284 tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
285 return 0;
286 }
287
sprint_spi(struct tc_rsvp_gpi * pi,int dir,char * buf)288 static char * sprint_spi(struct tc_rsvp_gpi *pi, int dir, char *buf)
289 {
290 if (pi->offset == 0) {
291 if (dir && pi->mask == htonl(0xFFFF)) {
292 snprintf(buf, SPRINT_BSIZE-1, "/%d", htonl(pi->key));
293 return buf;
294 }
295 if (!dir && pi->mask == htonl(0xFFFF0000)) {
296 snprintf(buf, SPRINT_BSIZE-1, "/%d", htonl(pi->key)>>16);
297 return buf;
298 }
299 if (pi->mask == htonl(0xFFFFFFFF)) {
300 snprintf(buf, SPRINT_BSIZE-1, " spi/esp 0x%08x", htonl(pi->key));
301 return buf;
302 }
303 } else if (pi->offset == 4 && pi->mask == htonl(0xFFFFFFFF)) {
304 snprintf(buf, SPRINT_BSIZE-1, " spi/ah 0x%08x", htonl(pi->key));
305 return buf;
306 } else if (pi->offset == -40 && pi->mask == htonl(0x000FFFFF)) {
307 snprintf(buf, SPRINT_BSIZE-1, " flowlabel 0x%05x", htonl(pi->key));
308 return buf;
309 }
310 snprintf(buf, SPRINT_BSIZE-1, " u32 0x%08x mask %08x at %d",
311 htonl(pi->key), htonl(pi->mask), pi->offset);
312 return buf;
313 }
314
rsvp_print_opt(struct filter_util * qu,FILE * f,struct rtattr * opt,__u32 handle)315 static int rsvp_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle)
316 {
317 int family = strcmp(qu->id, "rsvp") == 0 ? AF_INET : AF_INET6;
318 struct rtattr *tb[TCA_RSVP_MAX+1];
319 struct tc_rsvp_pinfo *pinfo = NULL;
320
321 if (opt == NULL)
322 return 0;
323
324 parse_rtattr_nested(tb, TCA_RSVP_MAX, opt);
325
326 if (handle)
327 fprintf(f, "fh 0x%08x ", handle);
328
329 if (tb[TCA_RSVP_PINFO]) {
330 if (RTA_PAYLOAD(tb[TCA_RSVP_PINFO]) < sizeof(*pinfo))
331 return -1;
332
333 pinfo = RTA_DATA(tb[TCA_RSVP_PINFO]);
334 }
335
336 if (tb[TCA_RSVP_CLASSID]) {
337 SPRINT_BUF(b1);
338 if (!pinfo || pinfo->tunnelhdr == 0)
339 fprintf(f, "flowid %s ", sprint_tc_classid(rta_getattr_u32(tb[TCA_RSVP_CLASSID]), b1));
340 else
341 fprintf(f, "tunnel %d skip %d ", rta_getattr_u32(tb[TCA_RSVP_CLASSID]), pinfo->tunnelhdr);
342 } else if (pinfo && pinfo->tunnelhdr)
343 fprintf(f, "tunnel [BAD] skip %d ", pinfo->tunnelhdr);
344
345 if (tb[TCA_RSVP_DST]) {
346 char buf[128];
347 fprintf(f, "session ");
348 if (inet_ntop(family, RTA_DATA(tb[TCA_RSVP_DST]), buf, sizeof(buf)) == 0)
349 fprintf(f, " [INVALID DADDR] ");
350 else
351 fprintf(f, "%s", buf);
352 if (pinfo && pinfo->dpi.mask) {
353 SPRINT_BUF(b2);
354 fprintf(f, "%s ", sprint_spi(&pinfo->dpi, 1, b2));
355 } else
356 fprintf(f, " ");
357 } else {
358 if (pinfo && pinfo->dpi.mask) {
359 SPRINT_BUF(b2);
360 fprintf(f, "session [NONE]%s ", sprint_spi(&pinfo->dpi, 1, b2));
361 } else
362 fprintf(f, "session NONE ");
363 }
364
365 if (pinfo && pinfo->protocol) {
366 SPRINT_BUF(b1);
367 fprintf(f, "ipproto %s ", inet_proto_n2a(pinfo->protocol, b1, sizeof(b1)));
368 }
369 if (pinfo && pinfo->tunnelid)
370 fprintf(f, "tunnelid %d ", pinfo->tunnelid);
371 if (tb[TCA_RSVP_SRC]) {
372 char buf[128];
373 fprintf(f, "sender ");
374 if (inet_ntop(family, RTA_DATA(tb[TCA_RSVP_SRC]), buf, sizeof(buf)) == 0) {
375 fprintf(f, "[BAD]");
376 } else {
377 fprintf(f, " %s", buf);
378 }
379 if (pinfo && pinfo->spi.mask) {
380 SPRINT_BUF(b2);
381 fprintf(f, "%s ", sprint_spi(&pinfo->spi, 0, b2));
382 } else
383 fprintf(f, " ");
384 } else if (pinfo && pinfo->spi.mask) {
385 SPRINT_BUF(b2);
386 fprintf(f, "sender [NONE]%s ", sprint_spi(&pinfo->spi, 0, b2));
387 }
388 if (tb[TCA_RSVP_POLICE])
389 tc_print_police(f, tb[TCA_RSVP_POLICE]);
390 return 0;
391 }
392
393 struct filter_util rsvp_filter_util = {
394 .id = "rsvp",
395 .parse_fopt = rsvp_parse_opt,
396 .print_fopt = rsvp_print_opt,
397 };
398
399 struct filter_util rsvp6_filter_util = {
400 .id = "rsvp6",
401 .parse_fopt = rsvp_parse_opt,
402 .print_fopt = rsvp_print_opt,
403 };
404