1 /*
2 * f_route.c ROUTE 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 "utils.h"
24 #include "rt_names.h"
25 #include "tc_common.h"
26 #include "tc_util.h"
27
explain(void)28 static void explain(void)
29 {
30 fprintf(stderr, "Usage: ... route [ from REALM | fromif TAG ] [ to REALM ]\n");
31 fprintf(stderr, " [ flowid CLASSID ] [ police POLICE_SPEC ]\n");
32 fprintf(stderr, " POLICE_SPEC := ... look at TBF\n");
33 fprintf(stderr, " CLASSID := X:Y\n");
34 fprintf(stderr, "\nNOTE: CLASSID is parsed as hexadecimal input.\n");
35 }
36
route_parse_opt(struct filter_util * qu,char * handle,int argc,char ** argv,struct nlmsghdr * n)37 static int route_parse_opt(struct filter_util *qu, char *handle, int argc, char **argv, struct nlmsghdr *n)
38 {
39 struct tc_police tp;
40 struct tcmsg *t = NLMSG_DATA(n);
41 struct rtattr *tail;
42 __u32 fh = 0xFFFF8000;
43 __u32 order = 0;
44
45 memset(&tp, 0, sizeof(tp));
46
47 if (handle) {
48 if (get_u32(&t->tcm_handle, handle, 0)) {
49 fprintf(stderr, "Illegal \"handle\"\n");
50 return -1;
51 }
52 }
53
54 if (argc == 0)
55 return 0;
56
57 tail = NLMSG_TAIL(n);
58 addattr_l(n, 4096, TCA_OPTIONS, NULL, 0);
59
60 while (argc > 0) {
61 if (matches(*argv, "to") == 0) {
62 __u32 id;
63 NEXT_ARG();
64 if (rtnl_rtrealm_a2n(&id, *argv)) {
65 fprintf(stderr, "Illegal \"to\"\n");
66 return -1;
67 }
68 addattr_l(n, 4096, TCA_ROUTE4_TO, &id, 4);
69 fh &= ~0x80FF;
70 fh |= id&0xFF;
71 } else if (matches(*argv, "from") == 0) {
72 __u32 id;
73 NEXT_ARG();
74 if (rtnl_rtrealm_a2n(&id, *argv)) {
75 fprintf(stderr, "Illegal \"from\"\n");
76 return -1;
77 }
78 addattr_l(n, 4096, TCA_ROUTE4_FROM, &id, 4);
79 fh &= 0xFFFF;
80 fh |= id<<16;
81 } else if (matches(*argv, "fromif") == 0) {
82 __u32 id;
83 NEXT_ARG();
84 ll_init_map(&rth);
85 if ((id=ll_name_to_index(*argv)) <= 0) {
86 fprintf(stderr, "Illegal \"fromif\"\n");
87 return -1;
88 }
89 addattr_l(n, 4096, TCA_ROUTE4_IIF, &id, 4);
90 fh &= 0xFFFF;
91 fh |= (0x8000|id)<<16;
92 } else if (matches(*argv, "classid") == 0 ||
93 strcmp(*argv, "flowid") == 0) {
94 unsigned handle;
95 NEXT_ARG();
96 if (get_tc_classid(&handle, *argv)) {
97 fprintf(stderr, "Illegal \"classid\"\n");
98 return -1;
99 }
100 addattr_l(n, 4096, TCA_ROUTE4_CLASSID, &handle, 4);
101 } else if (matches(*argv, "police") == 0) {
102 NEXT_ARG();
103 if (parse_police(&argc, &argv, TCA_ROUTE4_POLICE, n)) {
104 fprintf(stderr, "Illegal \"police\"\n");
105 return -1;
106 }
107 continue;
108 } else if (matches(*argv, "order") == 0) {
109 NEXT_ARG();
110 if (get_u32(&order, *argv, 0)) {
111 fprintf(stderr, "Illegal \"order\"\n");
112 return -1;
113 }
114 } else if (strcmp(*argv, "help") == 0) {
115 explain();
116 return -1;
117 } else {
118 fprintf(stderr, "What is \"%s\"?\n", *argv);
119 explain();
120 return -1;
121 }
122 argc--; argv++;
123 }
124 tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
125 if (order) {
126 fh &= ~0x7F00;
127 fh |= (order<<8)&0x7F00;
128 }
129 if (!t->tcm_handle)
130 t->tcm_handle = fh;
131 return 0;
132 }
133
route_print_opt(struct filter_util * qu,FILE * f,struct rtattr * opt,__u32 handle)134 static int route_print_opt(struct filter_util *qu, FILE *f, struct rtattr *opt, __u32 handle)
135 {
136 struct rtattr *tb[TCA_ROUTE4_MAX+1];
137 SPRINT_BUF(b1);
138
139 if (opt == NULL)
140 return 0;
141
142 parse_rtattr_nested(tb, TCA_ROUTE4_MAX, opt);
143
144 if (handle)
145 fprintf(f, "fh 0x%08x ", handle);
146 if (handle&0x7F00)
147 fprintf(f, "order %d ", (handle>>8)&0x7F);
148
149 if (tb[TCA_ROUTE4_CLASSID]) {
150 SPRINT_BUF(b1);
151 fprintf(f, "flowid %s ", sprint_tc_classid(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_CLASSID]), b1));
152 }
153 if (tb[TCA_ROUTE4_TO])
154 fprintf(f, "to %s ", rtnl_rtrealm_n2a(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_TO]), b1, sizeof(b1)));
155 if (tb[TCA_ROUTE4_FROM])
156 fprintf(f, "from %s ", rtnl_rtrealm_n2a(*(__u32*)RTA_DATA(tb[TCA_ROUTE4_FROM]), b1, sizeof(b1)));
157 if (tb[TCA_ROUTE4_IIF])
158 fprintf(f, "fromif %s", ll_index_to_name(*(int*)RTA_DATA(tb[TCA_ROUTE4_IIF])));
159 if (tb[TCA_ROUTE4_POLICE])
160 tc_print_police(f, tb[TCA_ROUTE4_POLICE]);
161 return 0;
162 }
163
164 struct filter_util route_filter_util = {
165 .id = "route",
166 .parse_fopt = route_parse_opt,
167 .print_fopt = route_print_opt,
168 };
169