]>
Commit | Line | Data |
---|---|---|
9e9d615e | 1 | /* |
2 | * q_htb.c HTB. | |
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: Martin Devera, devik@cdi.cz | |
10 | * | |
11 | */ | |
12 | ||
13 | #include <stdio.h> | |
14 | #include <stdlib.h> | |
15 | #include <unistd.h> | |
9e9d615e | 16 | #include <fcntl.h> |
17 | #include <sys/socket.h> | |
18 | #include <netinet/in.h> | |
19 | #include <arpa/inet.h> | |
20 | #include <string.h> | |
21 | ||
22 | #include "utils.h" | |
23 | #include "tc_util.h" | |
24 | ||
25 | #define HTB_TC_VER 0x30003 | |
26 | #if HTB_TC_VER >> 16 != TC_HTB_PROTOVER | |
27 | #error "Different kernel and TC HTB versions" | |
28 | #endif | |
29 | ||
30 | static void explain(void) | |
31 | { | |
32 | fprintf(stderr, "Usage: ... qdisc add ... htb [default N] [r2q N]\n" | |
b43f3318 | 33 | " [direct_qlen P]\n" |
9e9d615e | 34 | " default minor id of class to which unclassified packets are sent {0}\n" |
35 | " r2q DRR quantums are computed as rate in Bps/r2q {10}\n" | |
36 | " debug string of 16 numbers each 0-3 {0}\n\n" | |
b43f3318 | 37 | " direct_qlen Limit of the direct queue {in packets}\n" |
a166d246 SH |
38 | "... class add ... htb rate R1 [burst B1] [mpu B] [overhead O]\n" |
39 | " [prio P] [slot S] [pslot PS]\n" | |
9e9d615e | 40 | " [ceil R2] [cburst B2] [mtu MTU] [quantum Q]\n" |
41 | " rate rate allocated to this class (class can still borrow)\n" | |
42 | " burst max bytes burst which can be accumulated during idle period {computed}\n" | |
a166d246 SH |
43 | " mpu minimum packet size used in rate computations\n" |
44 | " overhead per-packet size overhead used in rate computations\n" | |
292f29b4 | 45 | " linklay adapting to a linklayer e.g. atm\n" |
9e9d615e | 46 | " ceil definite upper class rate (no borrows) {rate}\n" |
47 | " cburst burst but for ceil {computed}\n" | |
48 | " mtu max packet size we create rate map for {1600}\n" | |
49 | " prio priority of leaf; lower are served first {0}\n" | |
50 | " quantum how much bytes to serve from leaf at once {use r2q}\n" | |
32a121cb | 51 | "\nTC HTB version %d.%d\n", HTB_TC_VER>>16, HTB_TC_VER&0xffff |
9e9d615e | 52 | ); |
53 | } | |
54 | ||
55 | static void explain1(char *arg) | |
56 | { | |
57 | fprintf(stderr, "Illegal \"%s\"\n", arg); | |
58 | explain(); | |
59 | } | |
60 | ||
61 | ||
9e9d615e | 62 | static int htb_parse_opt(struct qdisc_util *qu, int argc, char **argv, struct nlmsghdr *n) |
63 | { | |
4d4da09e | 64 | unsigned int direct_qlen = ~0U; |
d17b136f PS |
65 | struct tc_htb_glob opt = { |
66 | .rate2quantum = 10, | |
67 | .version = 3, | |
68 | }; | |
9e9d615e | 69 | struct rtattr *tail; |
32a121cb SH |
70 | unsigned int i; char *p; |
71 | ||
9e9d615e | 72 | while (argc > 0) { |
73 | if (matches(*argv, "r2q") == 0) { | |
22fa92e3 SH |
74 | NEXT_ARG(); |
75 | if (get_u32(&opt.rate2quantum, *argv, 10)) { | |
76 | explain1("r2q"); return -1; | |
77 | } | |
9e9d615e | 78 | } else if (matches(*argv, "default") == 0) { |
22fa92e3 SH |
79 | NEXT_ARG(); |
80 | if (get_u32(&opt.defcls, *argv, 16)) { | |
81 | explain1("default"); return -1; | |
82 | } | |
9e9d615e | 83 | } else if (matches(*argv, "debug") == 0) { |
22fa92e3 | 84 | NEXT_ARG(); p = *argv; |
32a121cb SH |
85 | for (i = 0; i < 16; i++, p++) { |
86 | if (*p < '0' || *p > '3') break; | |
22fa92e3 SH |
87 | opt.debug |= (*p-'0')<<(2*i); |
88 | } | |
4d4da09e HS |
89 | } else if (matches(*argv, "direct_qlen") == 0) { |
90 | NEXT_ARG(); | |
91 | if (get_u32(&direct_qlen, *argv, 10)) { | |
92 | explain1("direct_qlen"); return -1; | |
93 | } | |
9e9d615e | 94 | } else { |
95 | fprintf(stderr, "What is \"%s\"?\n", *argv); | |
96 | explain(); | |
97 | return -1; | |
98 | } | |
99 | argc--; argv++; | |
100 | } | |
1b52a762 | 101 | tail = NLMSG_TAIL(n); |
9e9d615e | 102 | addattr_l(n, 1024, TCA_OPTIONS, NULL, 0); |
103 | addattr_l(n, 2024, TCA_HTB_INIT, &opt, NLMSG_ALIGN(sizeof(opt))); | |
4d4da09e HS |
104 | if (direct_qlen != ~0U) |
105 | addattr_l(n, 2024, TCA_HTB_DIRECT_QLEN, | |
106 | &direct_qlen, sizeof(direct_qlen)); | |
1b52a762 | 107 | tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail; |
9e9d615e | 108 | return 0; |
109 | } | |
110 | ||
111 | static int htb_parse_class_opt(struct qdisc_util *qu, int argc, char **argv, struct nlmsghdr *n) | |
112 | { | |
32a121cb | 113 | int ok = 0; |
d17b136f | 114 | struct tc_htb_opt opt = {}; |
32a121cb SH |
115 | __u32 rtab[256], ctab[256]; |
116 | unsigned buffer = 0, cbuffer = 0; | |
117 | int cell_log = -1, ccell_log = -1; | |
d17b136f | 118 | unsigned int mtu = 1600; /* eth packet len */ |
bccd014b JDB |
119 | unsigned short mpu = 0; |
120 | unsigned short overhead = 0; | |
292f29b4 | 121 | unsigned int linklayer = LINKLAYER_ETHERNET; /* Assume ethernet */ |
9e9d615e | 122 | struct rtattr *tail; |
8334bb32 | 123 | __u64 ceil64 = 0, rate64 = 0; |
9e9d615e | 124 | |
9e9d615e | 125 | while (argc > 0) { |
126 | if (matches(*argv, "prio") == 0) { | |
127 | NEXT_ARG(); | |
128 | if (get_u32(&opt.prio, *argv, 10)) { | |
129 | explain1("prio"); return -1; | |
130 | } | |
131 | ok++; | |
132 | } else if (matches(*argv, "mtu") == 0) { | |
133 | NEXT_ARG(); | |
134 | if (get_u32(&mtu, *argv, 10)) { | |
135 | explain1("mtu"); return -1; | |
136 | } | |
a166d246 SH |
137 | } else if (matches(*argv, "mpu") == 0) { |
138 | NEXT_ARG(); | |
bccd014b | 139 | if (get_u16(&mpu, *argv, 10)) { |
a166d246 SH |
140 | explain1("mpu"); return -1; |
141 | } | |
142 | } else if (matches(*argv, "overhead") == 0) { | |
143 | NEXT_ARG(); | |
bccd014b | 144 | if (get_u16(&overhead, *argv, 10)) { |
a166d246 SH |
145 | explain1("overhead"); return -1; |
146 | } | |
292f29b4 JDB |
147 | } else if (matches(*argv, "linklayer") == 0) { |
148 | NEXT_ARG(); | |
149 | if (get_linklayer(&linklayer, *argv)) { | |
150 | explain1("linklayer"); return -1; | |
151 | } | |
9e9d615e | 152 | } else if (matches(*argv, "quantum") == 0) { |
153 | NEXT_ARG(); | |
154 | if (get_u32(&opt.quantum, *argv, 10)) { | |
155 | explain1("quantum"); return -1; | |
156 | } | |
157 | } else if (matches(*argv, "burst") == 0 || | |
22fa92e3 SH |
158 | strcmp(*argv, "buffer") == 0 || |
159 | strcmp(*argv, "maxburst") == 0) { | |
9e9d615e | 160 | NEXT_ARG(); |
161 | if (get_size_and_cell(&buffer, &cell_log, *argv) < 0) { | |
162 | explain1("buffer"); | |
163 | return -1; | |
164 | } | |
165 | ok++; | |
166 | } else if (matches(*argv, "cburst") == 0 || | |
22fa92e3 SH |
167 | strcmp(*argv, "cbuffer") == 0 || |
168 | strcmp(*argv, "cmaxburst") == 0) { | |
9e9d615e | 169 | NEXT_ARG(); |
170 | if (get_size_and_cell(&cbuffer, &ccell_log, *argv) < 0) { | |
171 | explain1("cbuffer"); | |
172 | return -1; | |
173 | } | |
174 | ok++; | |
175 | } else if (strcmp(*argv, "ceil") == 0) { | |
176 | NEXT_ARG(); | |
8334bb32 | 177 | if (ceil64) { |
9e9d615e | 178 | fprintf(stderr, "Double \"ceil\" spec\n"); |
179 | return -1; | |
180 | } | |
8334bb32 | 181 | if (get_rate64(&ceil64, *argv)) { |
9e9d615e | 182 | explain1("ceil"); |
183 | return -1; | |
184 | } | |
185 | ok++; | |
186 | } else if (strcmp(*argv, "rate") == 0) { | |
187 | NEXT_ARG(); | |
8334bb32 | 188 | if (rate64) { |
9e9d615e | 189 | fprintf(stderr, "Double \"rate\" spec\n"); |
190 | return -1; | |
191 | } | |
8334bb32 | 192 | if (get_rate64(&rate64, *argv)) { |
9e9d615e | 193 | explain1("rate"); |
194 | return -1; | |
195 | } | |
196 | ok++; | |
197 | } else if (strcmp(*argv, "help") == 0) { | |
198 | explain(); | |
199 | return -1; | |
200 | } else { | |
201 | fprintf(stderr, "What is \"%s\"?\n", *argv); | |
202 | explain(); | |
203 | return -1; | |
204 | } | |
205 | argc--; argv++; | |
206 | } | |
207 | ||
22fa92e3 | 208 | /* if (!ok) |
9e9d615e | 209 | return 0;*/ |
210 | ||
8334bb32 | 211 | if (!rate64) { |
9e9d615e | 212 | fprintf(stderr, "\"rate\" is required.\n"); |
213 | return -1; | |
214 | } | |
215 | /* if ceil params are missing, use the same as rate */ | |
8334bb32 ED |
216 | if (!ceil64) |
217 | ceil64 = rate64; | |
218 | ||
219 | opt.rate.rate = (rate64 >= (1ULL << 32)) ? ~0U : rate64; | |
220 | opt.ceil.rate = (ceil64 >= (1ULL << 32)) ? ~0U : ceil64; | |
9e9d615e | 221 | |
222 | /* compute minimal allowed burst from rate; mtu is added here to make | |
223 | sute that buffer is larger than mtu and to have some safeguard space */ | |
8334bb32 ED |
224 | if (!buffer) |
225 | buffer = rate64 / get_hz() + mtu; | |
226 | if (!cbuffer) | |
227 | cbuffer = ceil64 / get_hz() + mtu; | |
9e9d615e | 228 | |
bccd014b JDB |
229 | opt.ceil.overhead = overhead; |
230 | opt.rate.overhead = overhead; | |
231 | ||
232 | opt.ceil.mpu = mpu; | |
233 | opt.rate.mpu = mpu; | |
a166d246 | 234 | |
292f29b4 | 235 | if (tc_calc_rtable(&opt.rate, rtab, cell_log, mtu, linklayer) < 0) { |
9e9d615e | 236 | fprintf(stderr, "htb: failed to calculate rate table.\n"); |
237 | return -1; | |
238 | } | |
8334bb32 | 239 | opt.buffer = tc_calc_xmittime(rate64, buffer); |
ae665a52 | 240 | |
292f29b4 | 241 | if (tc_calc_rtable(&opt.ceil, ctab, ccell_log, mtu, linklayer) < 0) { |
9e9d615e | 242 | fprintf(stderr, "htb: failed to calculate ceil rate table.\n"); |
243 | return -1; | |
244 | } | |
8334bb32 | 245 | opt.cbuffer = tc_calc_xmittime(ceil64, cbuffer); |
9e9d615e | 246 | |
1b52a762 | 247 | tail = NLMSG_TAIL(n); |
9e9d615e | 248 | addattr_l(n, 1024, TCA_OPTIONS, NULL, 0); |
8334bb32 ED |
249 | |
250 | if (rate64 >= (1ULL << 32)) | |
251 | addattr_l(n, 1124, TCA_HTB_RATE64, &rate64, sizeof(rate64)); | |
252 | ||
253 | if (ceil64 >= (1ULL << 32)) | |
254 | addattr_l(n, 1224, TCA_HTB_CEIL64, &ceil64, sizeof(ceil64)); | |
255 | ||
9e9d615e | 256 | addattr_l(n, 2024, TCA_HTB_PARMS, &opt, sizeof(opt)); |
257 | addattr_l(n, 3024, TCA_HTB_RTAB, rtab, 1024); | |
258 | addattr_l(n, 4024, TCA_HTB_CTAB, ctab, 1024); | |
1b52a762 | 259 | tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail; |
9e9d615e | 260 | return 0; |
261 | } | |
262 | ||
263 | static int htb_print_opt(struct qdisc_util *qu, FILE *f, struct rtattr *opt) | |
264 | { | |
b43f3318 | 265 | struct rtattr *tb[TCA_HTB_MAX + 1]; |
9e9d615e | 266 | struct tc_htb_opt *hopt; |
267 | struct tc_htb_glob *gopt; | |
32a121cb | 268 | double buffer, cbuffer; |
3e92ff52 | 269 | unsigned int linklayer; |
8334bb32 | 270 | __u64 rate64, ceil64; |
32a121cb | 271 | |
9e9d615e | 272 | SPRINT_BUF(b1); |
273 | SPRINT_BUF(b2); | |
467f9fce | 274 | SPRINT_BUF(b3); |
9e9d615e | 275 | |
276 | if (opt == NULL) | |
277 | return 0; | |
278 | ||
b43f3318 | 279 | parse_rtattr_nested(tb, TCA_HTB_MAX, opt); |
9e9d615e | 280 | |
281 | if (tb[TCA_HTB_PARMS]) { | |
22fa92e3 SH |
282 | hopt = RTA_DATA(tb[TCA_HTB_PARMS]); |
283 | if (RTA_PAYLOAD(tb[TCA_HTB_PARMS]) < sizeof(*hopt)) return -1; | |
9e9d615e | 284 | |
285 | if (!hopt->level) { | |
286 | fprintf(f, "prio %d ", (int)hopt->prio); | |
287 | if (show_details) | |
288 | fprintf(f, "quantum %d ", (int)hopt->quantum); | |
289 | } | |
8334bb32 ED |
290 | |
291 | rate64 = hopt->rate.rate; | |
292 | if (tb[TCA_HTB_RATE64] && | |
293 | RTA_PAYLOAD(tb[TCA_HTB_RATE64]) >= sizeof(rate64)) { | |
294 | rate64 = rta_getattr_u64(tb[TCA_HTB_RATE64]); | |
295 | } | |
296 | ||
297 | ceil64 = hopt->ceil.rate; | |
298 | if (tb[TCA_HTB_CEIL64] && | |
299 | RTA_PAYLOAD(tb[TCA_HTB_CEIL64]) >= sizeof(ceil64)) | |
300 | ceil64 = rta_getattr_u64(tb[TCA_HTB_CEIL64]); | |
301 | ||
302 | fprintf(f, "rate %s ", sprint_rate(rate64, b1)); | |
22fa92e3 SH |
303 | if (hopt->rate.overhead) |
304 | fprintf(f, "overhead %u ", hopt->rate.overhead); | |
8334bb32 ED |
305 | buffer = tc_calc_xmitsize(rate64, hopt->buffer); |
306 | ||
307 | fprintf(f, "ceil %s ", sprint_rate(ceil64, b1)); | |
308 | cbuffer = tc_calc_xmitsize(ceil64, hopt->cbuffer); | |
3e92ff52 JDB |
309 | linklayer = (hopt->rate.linklayer & TC_LINKLAYER_MASK); |
310 | if (linklayer > TC_LINKLAYER_ETHERNET || show_details) | |
467f9fce | 311 | fprintf(f, "linklayer %s ", sprint_linklayer(linklayer, b3)); |
22fa92e3 | 312 | if (show_details) { |
1aea7fea | 313 | fprintf(f, "burst %s/%u mpu %s ", |
22fa92e3 SH |
314 | sprint_size(buffer, b1), |
315 | 1<<hopt->rate.cell_log, | |
1aea7fea DS |
316 | sprint_size(hopt->rate.mpu, b2)); |
317 | fprintf(f, "cburst %s/%u mpu %s ", | |
22fa92e3 SH |
318 | sprint_size(cbuffer, b1), |
319 | 1<<hopt->ceil.cell_log, | |
1aea7fea | 320 | sprint_size(hopt->ceil.mpu, b2)); |
22fa92e3 SH |
321 | fprintf(f, "level %d ", (int)hopt->level); |
322 | } else { | |
323 | fprintf(f, "burst %s ", sprint_size(buffer, b1)); | |
324 | fprintf(f, "cburst %s ", sprint_size(cbuffer, b1)); | |
325 | } | |
326 | if (show_raw) | |
327 | fprintf(f, "buffer [%08x] cbuffer [%08x] ", | |
32a121cb | 328 | hopt->buffer, hopt->cbuffer); |
9e9d615e | 329 | } |
330 | if (tb[TCA_HTB_INIT]) { | |
22fa92e3 SH |
331 | gopt = RTA_DATA(tb[TCA_HTB_INIT]); |
332 | if (RTA_PAYLOAD(tb[TCA_HTB_INIT]) < sizeof(*gopt)) return -1; | |
9e9d615e | 333 | |
22fa92e3 | 334 | fprintf(f, "r2q %d default %x direct_packets_stat %u", |
32a121cb | 335 | gopt->rate2quantum, gopt->defcls, gopt->direct_pkts); |
9e9d615e | 336 | if (show_details) |
32a121cb | 337 | fprintf(f, " ver %d.%d", gopt->version >> 16, gopt->version & 0xffff); |
9e9d615e | 338 | } |
b43f3318 ED |
339 | if (tb[TCA_HTB_DIRECT_QLEN] && |
340 | RTA_PAYLOAD(tb[TCA_HTB_DIRECT_QLEN]) >= sizeof(__u32)) { | |
341 | __u32 direct_qlen = rta_getattr_u32(tb[TCA_HTB_DIRECT_QLEN]); | |
342 | ||
343 | fprintf(f, " direct_qlen %u", direct_qlen); | |
344 | } | |
9e9d615e | 345 | return 0; |
346 | } | |
347 | ||
348 | static int htb_print_xstats(struct qdisc_util *qu, FILE *f, struct rtattr *xstats) | |
349 | { | |
350 | struct tc_htb_xstats *st; | |
32a121cb | 351 | |
9e9d615e | 352 | if (xstats == NULL) |
353 | return 0; | |
354 | ||
355 | if (RTA_PAYLOAD(xstats) < sizeof(*st)) | |
356 | return -1; | |
357 | ||
358 | st = RTA_DATA(xstats); | |
ae665a52 | 359 | fprintf(f, " lended: %u borrowed: %u giants: %u\n", |
32a121cb SH |
360 | st->lends, st->borrows, st->giants); |
361 | fprintf(f, " tokens: %d ctokens: %d\n", st->tokens, st->ctokens); | |
9e9d615e | 362 | return 0; |
363 | } | |
364 | ||
95812b56 | 365 | struct qdisc_util htb_qdisc_util = { |
32a121cb | 366 | .id = "htb", |
f2f99e2e SH |
367 | .parse_qopt = htb_parse_opt, |
368 | .print_qopt = htb_print_opt, | |
32a121cb | 369 | .print_xstats = htb_print_xstats, |
f2f99e2e SH |
370 | .parse_copt = htb_parse_class_opt, |
371 | .print_copt = htb_print_opt, | |
9e9d615e | 372 | }; |