]>
Commit | Line | Data |
---|---|---|
aba5acdf SH |
1 | /* |
2 | * m_police.c Parse/print policing module options. | |
3 | * | |
4 | * This program is free software; you can u32istribute 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 | * FIXES: 19990619 - J Hadi Salim (hadi@cyberus.ca) | |
11 | * simple addattr packaging fix. | |
12 | */ | |
13 | ||
14 | #include <stdio.h> | |
15 | #include <stdlib.h> | |
16 | #include <unistd.h> | |
17 | #include <syslog.h> | |
18 | #include <fcntl.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 | static void explain(void) | |
28 | { | |
29 | fprintf(stderr, "Usage: ... police rate BPS burst BYTES[/BYTES] [ mtu BYTES[/BYTES] ]\n"); | |
30 | fprintf(stderr, " [ peakrate BPS ] [ avrate BPS ]\n"); | |
31 | fprintf(stderr, " [ ACTION ]\n"); | |
32 | fprintf(stderr, "Where: ACTION := reclassify | drop | continue \n"); | |
33 | } | |
34 | ||
35 | static void explain1(char *arg) | |
36 | { | |
37 | fprintf(stderr, "Illegal \"%s\"\n", arg); | |
38 | } | |
39 | ||
40 | #define usage() return(-1) | |
41 | ||
42 | ||
43 | char *police_action_n2a(int action, char *buf, int len) | |
44 | { | |
45 | switch (action) { | |
46 | case -1: | |
47 | return "continue"; | |
48 | break; | |
49 | case TC_POLICE_OK: | |
50 | return "pass"; | |
51 | break; | |
52 | case TC_POLICE_SHOT: | |
53 | return "drop"; | |
54 | break; | |
55 | case TC_POLICE_RECLASSIFY: | |
56 | return "reclassify"; | |
57 | default: | |
58 | snprintf(buf, len, "%d", action); | |
59 | return buf; | |
60 | } | |
61 | } | |
62 | ||
63 | int police_action_a2n(char *arg, int *result) | |
64 | { | |
65 | int res; | |
66 | ||
67 | if (matches(arg, "continue") == 0) | |
68 | res = -1; | |
69 | else if (matches(arg, "drop") == 0) | |
70 | res = TC_POLICE_SHOT; | |
71 | else if (matches(arg, "shot") == 0) | |
72 | res = TC_POLICE_SHOT; | |
73 | else if (matches(arg, "pass") == 0) | |
74 | res = TC_POLICE_OK; | |
75 | else if (strcmp(arg, "ok") == 0) | |
76 | res = TC_POLICE_OK; | |
77 | else if (matches(arg, "reclassify") == 0) | |
78 | res = TC_POLICE_RECLASSIFY; | |
79 | else { | |
80 | char dummy; | |
81 | if (sscanf(arg, "%d%c", &res, &dummy) != 1) | |
82 | return -1; | |
83 | } | |
84 | *result = res; | |
85 | return 0; | |
86 | } | |
87 | ||
88 | ||
89 | int get_police_result(int *action, int *result, char *arg) | |
90 | { | |
91 | char *p = strchr(arg, '/'); | |
92 | ||
93 | if (p) | |
94 | *p = 0; | |
95 | ||
96 | if (police_action_a2n(arg, action)) { | |
97 | if (p) | |
98 | *p = '/'; | |
99 | return -1; | |
100 | } | |
101 | ||
102 | if (p) { | |
103 | *p = '/'; | |
104 | if (police_action_a2n(p+1, result)) | |
105 | return -1; | |
106 | } | |
107 | return 0; | |
108 | } | |
109 | ||
110 | int parse_police(int *argc_p, char ***argv_p, int tca_id, struct nlmsghdr *n) | |
111 | { | |
112 | int argc = *argc_p; | |
113 | char **argv = *argv_p; | |
114 | int res = -1; | |
115 | int ok=0; | |
116 | struct tc_police p; | |
117 | __u32 rtab[256]; | |
118 | __u32 ptab[256]; | |
119 | __u32 avrate = 0; | |
120 | int presult = 0; | |
121 | unsigned buffer=0, mtu=0, mpu=0; | |
122 | int Rcell_log=-1, Pcell_log = -1; | |
123 | struct rtattr *tail; | |
124 | ||
125 | memset(&p, 0, sizeof(p)); | |
126 | p.action = TC_POLICE_RECLASSIFY; | |
127 | ||
128 | if (argc <= 0) | |
129 | return -1; | |
130 | ||
131 | while (argc > 0) { | |
132 | if (matches(*argv, "index") == 0) { | |
133 | NEXT_ARG(); | |
134 | if (get_u32(&p.index, *argv, 16)) { | |
135 | fprintf(stderr, "Illegal \"index\"\n"); | |
136 | return -1; | |
137 | } | |
138 | } else if (matches(*argv, "burst") == 0 || | |
139 | strcmp(*argv, "buffer") == 0 || | |
140 | strcmp(*argv, "maxburst") == 0) { | |
141 | NEXT_ARG(); | |
142 | if (buffer) { | |
143 | fprintf(stderr, "Double \"buffer/burst\" spec\n"); | |
144 | return -1; | |
145 | } | |
146 | if (get_size_and_cell(&buffer, &Rcell_log, *argv) < 0) { | |
147 | explain1("buffer"); | |
148 | return -1; | |
149 | } | |
150 | } else if (strcmp(*argv, "mtu") == 0 || | |
151 | strcmp(*argv, "minburst") == 0) { | |
152 | NEXT_ARG(); | |
153 | if (mtu) { | |
154 | fprintf(stderr, "Double \"mtu/minburst\" spec\n"); | |
155 | return -1; | |
156 | } | |
157 | if (get_size_and_cell(&mtu, &Pcell_log, *argv) < 0) { | |
158 | explain1("mtu"); | |
159 | return -1; | |
160 | } | |
161 | } else if (strcmp(*argv, "mpu") == 0) { | |
162 | NEXT_ARG(); | |
163 | if (mpu) { | |
164 | fprintf(stderr, "Double \"mpu\" spec\n"); | |
165 | return -1; | |
166 | } | |
167 | if (get_size(&mpu, *argv)) { | |
168 | explain1("mpu"); | |
169 | return -1; | |
170 | } | |
171 | } else if (strcmp(*argv, "rate") == 0) { | |
172 | NEXT_ARG(); | |
173 | if (p.rate.rate) { | |
174 | fprintf(stderr, "Double \"rate\" spec\n"); | |
175 | return -1; | |
176 | } | |
177 | if (get_rate(&p.rate.rate, *argv)) { | |
178 | explain1("rate"); | |
179 | return -1; | |
180 | } | |
181 | } else if (strcmp(*argv, "avrate") == 0) { | |
182 | NEXT_ARG(); | |
183 | if (avrate) { | |
184 | fprintf(stderr, "Double \"avrate\" spec\n"); | |
185 | return -1; | |
186 | } | |
187 | if (get_rate(&avrate, *argv)) { | |
188 | explain1("avrate"); | |
189 | return -1; | |
190 | } | |
191 | } else if (matches(*argv, "peakrate") == 0) { | |
192 | NEXT_ARG(); | |
193 | if (p.peakrate.rate) { | |
194 | fprintf(stderr, "Double \"peakrate\" spec\n"); | |
195 | return -1; | |
196 | } | |
197 | if (get_rate(&p.peakrate.rate, *argv)) { | |
198 | explain1("peakrate"); | |
199 | return -1; | |
200 | } | |
201 | } else if (matches(*argv, "reclassify") == 0) { | |
202 | p.action = TC_POLICE_RECLASSIFY; | |
203 | } else if (matches(*argv, "drop") == 0 || | |
204 | matches(*argv, "shot") == 0) { | |
205 | p.action = TC_POLICE_SHOT; | |
206 | } else if (matches(*argv, "continue") == 0) { | |
207 | p.action = TC_POLICE_UNSPEC; | |
208 | } else if (matches(*argv, "pass") == 0) { | |
209 | p.action = TC_POLICE_OK; | |
210 | } else if (strcmp(*argv, "action") == 0) { | |
211 | NEXT_ARG(); | |
212 | if (get_police_result(&p.action, &presult, *argv)) { | |
213 | fprintf(stderr, "Illegal \"action\"\n"); | |
214 | return -1; | |
215 | } | |
216 | } else if (strcmp(*argv, "help") == 0) { | |
217 | explain(); | |
218 | return -1; | |
219 | } else { | |
220 | break; | |
221 | } | |
222 | ok++; | |
223 | argc--; argv++; | |
224 | } | |
225 | ||
226 | if (!ok) | |
227 | return -1; | |
228 | ||
229 | if (p.rate.rate && !buffer) { | |
230 | fprintf(stderr, "\"burst\" requires \"rate\".\n"); | |
231 | return -1; | |
232 | } | |
233 | if (p.peakrate.rate) { | |
234 | if (!p.rate.rate) { | |
235 | fprintf(stderr, "\"peakrate\" requires \"rate\".\n"); | |
236 | return -1; | |
237 | } | |
238 | if (!mtu) { | |
239 | fprintf(stderr, "\"mtu\" is required, if \"peakrate\" is requested.\n"); | |
240 | return -1; | |
241 | } | |
242 | } | |
243 | ||
244 | if (p.rate.rate) { | |
245 | if ((Rcell_log = tc_calc_rtable(p.rate.rate, rtab, Rcell_log, mtu, mpu)) < 0) { | |
246 | fprintf(stderr, "TBF: failed to calculate rate table.\n"); | |
247 | return -1; | |
248 | } | |
249 | p.burst = tc_calc_xmittime(p.rate.rate, buffer); | |
250 | p.rate.cell_log = Rcell_log; | |
251 | p.rate.mpu = mpu; | |
252 | } | |
253 | p.mtu = mtu; | |
254 | if (p.peakrate.rate) { | |
255 | if ((Pcell_log = tc_calc_rtable(p.peakrate.rate, ptab, Pcell_log, mtu, mpu)) < 0) { | |
256 | fprintf(stderr, "POLICE: failed to calculate peak rate table.\n"); | |
257 | return -1; | |
258 | } | |
259 | p.peakrate.cell_log = Pcell_log; | |
260 | p.peakrate.mpu = mpu; | |
261 | } | |
262 | ||
263 | tail = (struct rtattr*)(((void*)n)+NLMSG_ALIGN(n->nlmsg_len)); | |
264 | addattr_l(n, 1024, tca_id, NULL, 0); | |
265 | addattr_l(n, 2024, TCA_POLICE_TBF, &p, sizeof(p)); | |
266 | if (p.rate.rate) | |
267 | addattr_l(n, 3024, TCA_POLICE_RATE, rtab, 1024); | |
268 | if (p.peakrate.rate) | |
269 | addattr_l(n, 4096, TCA_POLICE_PEAKRATE, ptab, 1024); | |
270 | if (avrate) | |
271 | addattr32(n, 4096, TCA_POLICE_AVRATE, avrate); | |
272 | if (presult) | |
273 | addattr32(n, 4096, TCA_POLICE_RESULT, presult); | |
274 | #if 0 | |
275 | #endif | |
276 | ||
277 | tail->rta_len = (((void*)n)+NLMSG_ALIGN(n->nlmsg_len)) - (void*)tail; | |
278 | res = 0; | |
279 | ||
280 | *argc_p = argc; | |
281 | *argv_p = argv; | |
282 | return res; | |
283 | } | |
284 | ||
285 | ||
286 | int tc_print_police(FILE *f, struct rtattr *arg) | |
287 | { | |
288 | SPRINT_BUF(b1); | |
289 | struct tc_police *p; | |
290 | struct rtattr *tb[TCA_POLICE_MAX+1]; | |
291 | unsigned buffer; | |
292 | ||
293 | if (arg == NULL) | |
294 | return 0; | |
295 | ||
296 | memset(tb, 0, sizeof(tb)); | |
297 | parse_rtattr(tb, TCA_POLICE_MAX, RTA_DATA(arg), RTA_PAYLOAD(arg)); | |
298 | ||
299 | if (tb[TCA_POLICE_TBF] == NULL) { | |
300 | fprintf(f, "[NULL police tbf]"); | |
301 | return 0; | |
302 | } | |
303 | if (RTA_PAYLOAD(tb[TCA_POLICE_TBF]) < sizeof(*p)) { | |
304 | fprintf(f, "[truncated police tbf]"); | |
305 | return -1; | |
306 | } | |
307 | p = RTA_DATA(tb[TCA_POLICE_TBF]); | |
308 | ||
309 | fprintf(f, "police %x ", p->index); | |
310 | fprintf(f, "action %s", police_action_n2a(p->action, b1, sizeof(b1))); | |
311 | if (tb[TCA_POLICE_RESULT]) { | |
312 | fprintf(f, "/%s ", police_action_n2a(*(int*)RTA_DATA(tb[TCA_POLICE_RESULT]), b1, sizeof(b1))); | |
313 | } else | |
314 | fprintf(f, " "); | |
315 | fprintf(f, "rate %s ", sprint_rate(p->rate.rate, b1)); | |
316 | buffer = ((double)p->rate.rate*tc_core_tick2usec(p->burst))/1000000; | |
317 | fprintf(f, "burst %s ", sprint_size(buffer, b1)); | |
318 | fprintf(f, "mtu %s ", sprint_size(p->mtu, b1)); | |
319 | if (show_raw) | |
320 | fprintf(f, "[%08x] ", p->burst); | |
321 | if (p->peakrate.rate) | |
322 | fprintf(f, "peakrate %s ", sprint_rate(p->peakrate.rate, b1)); | |
323 | if (tb[TCA_POLICE_AVRATE]) | |
324 | fprintf(f, "avrate %s ", sprint_rate(*(__u32*)RTA_DATA(tb[TCA_POLICE_AVRATE]), b1)); | |
325 | ||
326 | return 0; | |
327 | } | |
328 |