1 /*
2 * q_gred.c GRED.
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: J Hadi Salim(hadi@nortelnetworks.com)
10 * code ruthlessly ripped from
11 * Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
12 *
13 */
14
15 #include <stdio.h>
16 #include <stdlib.h>
17 #include <unistd.h>
18 #include <syslog.h>
19 #include <fcntl.h>
20 #include <sys/socket.h>
21 #include <netinet/in.h>
22 #include <arpa/inet.h>
23 #include <string.h>
24
25 #include "utils.h"
26 #include "tc_util.h"
27
28 #include "tc_red.h"
29
30
31 #if 0
32 #define DPRINTF(format,args...) fprintf(stderr,format,##args)
33 #else
34 #define DPRINTF(format,args...)
35 #endif
36
explain(void)37 static void explain(void)
38 {
39 fprintf(stderr, "Usage: ... gred DP drop-probability limit BYTES "
40 "min BYTES max BYTES\n");
41 fprintf(stderr, " avpkt BYTES burst PACKETS probability PROBABILITY "
42 "bandwidth KBPS\n");
43 fprintf(stderr, " [prio value]\n");
44 fprintf(stderr," OR ...\n");
45 fprintf(stderr," gred setup DPs <num of DPs> default <default DP> "
46 "[grio]\n");
47 }
48
init_gred(struct qdisc_util * qu,int argc,char ** argv,struct nlmsghdr * n)49 static int init_gred(struct qdisc_util *qu, int argc, char **argv,
50 struct nlmsghdr *n)
51 {
52
53 struct rtattr *tail;
54 struct tc_gred_sopt opt;
55 int dps = 0;
56 int def_dp = -1;
57
58 while (argc > 0) {
59 DPRINTF(stderr,"init_gred: invoked with %s\n",*argv);
60 if (strcmp(*argv, "DPs") == 0) {
61 NEXT_ARG();
62 DPRINTF(stderr,"init_gred: next_arg with %s\n",*argv);
63 dps = strtol(*argv, (char **)NULL, 10);
64 if (dps < 0 || dps >MAX_DPs) {
65 fprintf(stderr, "DPs =%d\n", dps);
66 fprintf(stderr, "Illegal \"DPs\"\n");
67 fprintf(stderr, "GRED: only %d DPs are "
68 "currently supported\n",MAX_DPs);
69 return -1;
70 }
71 } else if (strcmp(*argv, "default") == 0) {
72 NEXT_ARG();
73 def_dp = strtol(*argv, (char **)NULL, 10);
74 if (dps == 0) {
75 fprintf(stderr, "\"default DP\" must be "
76 "defined after DPs\n");
77 return -1;
78 }
79 if (def_dp < 0 || def_dp > dps) {
80 fprintf(stderr,
81 "\"default DP\" must be less than %d\n",
82 opt.DPs);
83 return -1;
84 }
85 } else if (strcmp(*argv, "grio") == 0) {
86 opt.grio=1;
87 } else if (strcmp(*argv, "help") == 0) {
88 explain();
89 return -1;
90 } else {
91 fprintf(stderr, "What is \"%s\"?\n", *argv);
92 explain();
93 return -1;
94 }
95 argc--; argv++;
96 }
97
98 if (!dps || def_dp == -1) {
99 fprintf(stderr, "Illegal gred setup parameters \n");
100 return -1;
101 }
102
103 memset(&opt, 0, sizeof(struct tc_gred_sopt));
104 opt.DPs = dps;
105 opt.def_DP = def_dp;
106
107 DPRINTF("TC_GRED: sending DPs=%d default=%d\n",opt.DPs,opt.def_DP);
108 n->nlmsg_flags|=NLM_F_CREATE;
109 tail = NLMSG_TAIL(n);
110 addattr_l(n, 1024, TCA_OPTIONS, NULL, 0);
111 addattr_l(n, 1024, TCA_GRED_DPS, &opt, sizeof(struct tc_gred_sopt));
112 tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
113 return 0;
114 }
115 /*
116 ^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^^
117 */
gred_parse_opt(struct qdisc_util * qu,int argc,char ** argv,struct nlmsghdr * n)118 static int gred_parse_opt(struct qdisc_util *qu, int argc, char **argv, struct nlmsghdr *n)
119 {
120 int ok=0;
121 struct tc_gred_qopt opt;
122 unsigned burst = 0;
123 unsigned avpkt = 0;
124 double probability = 0.02;
125 unsigned rate = 0;
126 int wlog;
127 __u8 sbuf[256];
128 struct rtattr *tail;
129
130 memset(&opt, 0, sizeof(opt));
131
132 while (argc > 0) {
133 if (strcmp(*argv, "limit") == 0) {
134 NEXT_ARG();
135 if (get_size(&opt.limit, *argv)) {
136 fprintf(stderr, "Illegal \"limit\"\n");
137 return -1;
138 }
139 ok++;
140 } else if (strcmp(*argv, "setup") == 0) {
141 if (ok) {
142 fprintf(stderr, "Illegal \"setup\"\n");
143 return -1;
144 }
145 return init_gred(qu,argc-1, argv+1,n);
146
147 } else if (strcmp(*argv, "min") == 0) {
148 NEXT_ARG();
149 if (get_size(&opt.qth_min, *argv)) {
150 fprintf(stderr, "Illegal \"min\"\n");
151 return -1;
152 }
153 ok++;
154 } else if (strcmp(*argv, "max") == 0) {
155 NEXT_ARG();
156 if (get_size(&opt.qth_max, *argv)) {
157 fprintf(stderr, "Illegal \"max\"\n");
158 return -1;
159 }
160 ok++;
161 } else if (strcmp(*argv, "DP") == 0) {
162 NEXT_ARG();
163 opt.DP=strtol(*argv, (char **)NULL, 10);
164 DPRINTF ("\n ******* DP =%u\n",opt.DP);
165 if (opt.DP >MAX_DPs) { /* need a better error check */
166 fprintf(stderr, "DP =%u \n",opt.DP);
167 fprintf(stderr, "Illegal \"DP\"\n");
168 fprintf(stderr, "GRED: only %d DPs are currently supported\n",MAX_DPs);
169 return -1;
170 }
171 ok++;
172 } else if (strcmp(*argv, "burst") == 0) {
173 NEXT_ARG();
174 if (get_unsigned(&burst, *argv, 0)) {
175 fprintf(stderr, "Illegal \"burst\"\n");
176 return -1;
177 }
178 ok++;
179 } else if (strcmp(*argv, "avpkt") == 0) {
180 NEXT_ARG();
181 if (get_size(&avpkt, *argv)) {
182 fprintf(stderr, "Illegal \"avpkt\"\n");
183 return -1;
184 }
185 ok++;
186 } else if (strcmp(*argv, "probability") == 0) {
187 NEXT_ARG();
188 if (sscanf(*argv, "%lg", &probability) != 1) {
189 fprintf(stderr, "Illegal \"probability\"\n");
190 return -1;
191 }
192 ok++;
193 } else if (strcmp(*argv, "prio") == 0) {
194 NEXT_ARG();
195 opt.prio=strtol(*argv, (char **)NULL, 10);
196 /* some error check here */
197 ok++;
198 } else if (strcmp(*argv, "bandwidth") == 0) {
199 NEXT_ARG();
200 if (get_rate(&rate, *argv)) {
201 fprintf(stderr, "Illegal \"bandwidth\"\n");
202 return -1;
203 }
204 ok++;
205 } else if (strcmp(*argv, "help") == 0) {
206 explain();
207 return -1;
208 } else {
209 fprintf(stderr, "What is \"%s\"?\n", *argv);
210 explain();
211 return -1;
212 }
213 argc--; argv++;
214 }
215
216 if (rate == 0)
217 get_rate(&rate, "10Mbit");
218
219 if (!opt.qth_min || !opt.qth_max || !burst || !opt.limit || !avpkt ||
220 (opt.DP<0)) {
221 fprintf(stderr, "Required parameter (min, max, burst, limit, "
222 "avpkt, DP) is missing\n");
223 return -1;
224 }
225
226 if ((wlog = tc_red_eval_ewma(opt.qth_min, burst, avpkt)) < 0) {
227 fprintf(stderr, "GRED: failed to calculate EWMA constant.\n");
228 return -1;
229 }
230 if (wlog >= 10)
231 fprintf(stderr, "GRED: WARNING. Burst %d seems to be to "
232 "large.\n", burst);
233 opt.Wlog = wlog;
234 if ((wlog = tc_red_eval_P(opt.qth_min, opt.qth_max, probability)) < 0) {
235 fprintf(stderr, "GRED: failed to calculate probability.\n");
236 return -1;
237 }
238 opt.Plog = wlog;
239 if ((wlog = tc_red_eval_idle_damping(opt.Wlog, avpkt, rate, sbuf)) < 0)
240 {
241 fprintf(stderr, "GRED: failed to calculate idle damping "
242 "table.\n");
243 return -1;
244 }
245 opt.Scell_log = wlog;
246
247 tail = NLMSG_TAIL(n);
248 addattr_l(n, 1024, TCA_OPTIONS, NULL, 0);
249 addattr_l(n, 1024, TCA_GRED_PARMS, &opt, sizeof(opt));
250 addattr_l(n, 1024, TCA_GRED_STAB, sbuf, 256);
251 tail->rta_len = (void *) NLMSG_TAIL(n) - (void *) tail;
252 return 0;
253 }
254
gred_print_opt(struct qdisc_util * qu,FILE * f,struct rtattr * opt)255 static int gred_print_opt(struct qdisc_util *qu, FILE *f, struct rtattr *opt)
256 {
257 struct rtattr *tb[TCA_GRED_STAB+1];
258 struct tc_gred_qopt *qopt;
259 int i;
260 SPRINT_BUF(b1);
261 SPRINT_BUF(b2);
262 SPRINT_BUF(b3);
263 SPRINT_BUF(b4);
264 SPRINT_BUF(b5);
265
266 if (opt == NULL)
267 return 0;
268
269 parse_rtattr_nested(tb, TCA_GRED_STAB, opt);
270
271 if (tb[TCA_GRED_PARMS] == NULL)
272 return -1;
273
274 qopt = RTA_DATA(tb[TCA_GRED_PARMS]);
275 if (RTA_PAYLOAD(tb[TCA_GRED_PARMS]) < sizeof(*qopt)*MAX_DPs) {
276 fprintf(f,"\n GRED received message smaller than expected\n");
277 return -1;
278 }
279
280 /* Bad hack! should really return a proper message as shown above*/
281
282 for (i=0;i<MAX_DPs;i++, qopt++) {
283 if (qopt->DP >= MAX_DPs) continue;
284 fprintf(f, "\n DP:%d (prio %d) Average Queue %s Measured "
285 "Queue %s ",
286 qopt->DP,
287 qopt->prio,
288 sprint_size(qopt->qave, b4),
289 sprint_size(qopt->backlog, b5));
290 fprintf(f, "\n\t Packet drops: %d (forced %d early %d) ",
291 qopt->forced+qopt->early,
292 qopt->forced,
293 qopt->early);
294 fprintf(f, "\n\t Packet totals: %u (bytes %u) ",
295 qopt->packets,
296 qopt->bytesin);
297 if (show_details)
298 fprintf(f, "\n limit %s min %s max %s ",
299 sprint_size(qopt->limit, b1),
300 sprint_size(qopt->qth_min, b2),
301 sprint_size(qopt->qth_max, b3));
302 fprintf(f, "ewma %u Plog %u Scell_log %u",
303 qopt->Wlog, qopt->Plog, qopt->Scell_log);
304 }
305 return 0;
306 }
307
308 struct qdisc_util gred_qdisc_util = {
309 .id = "gred",
310 .parse_qopt = gred_parse_opt,
311 .print_qopt = gred_print_opt,
312 };
313