• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * tc_class.c		"tc class".
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 #include <math.h>
23 
24 #include "utils.h"
25 #include "tc_util.h"
26 #include "tc_common.h"
27 
28 static void usage(void);
29 
usage(void)30 static void usage(void)
31 {
32 	fprintf(stderr, "Usage: tc class [ add | del | change | replace | show ] dev STRING\n");
33 	fprintf(stderr, "       [ classid CLASSID ] [ root | parent CLASSID ]\n");
34 	fprintf(stderr, "       [ [ QDISC_KIND ] [ help | OPTIONS ] ]\n");
35 	fprintf(stderr, "\n");
36 	fprintf(stderr, "       tc class show [ dev STRING ] [ root | parent CLASSID ]\n");
37 	fprintf(stderr, "Where:\n");
38 	fprintf(stderr, "QDISC_KIND := { prio | cbq | etc. }\n");
39 	fprintf(stderr, "OPTIONS := ... try tc class add <desired QDISC_KIND> help\n");
40 	return;
41 }
42 
tc_class_modify(int cmd,unsigned flags,int argc,char ** argv)43 int tc_class_modify(int cmd, unsigned flags, int argc, char **argv)
44 {
45 	struct {
46 		struct nlmsghdr 	n;
47 		struct tcmsg 		t;
48 		char   			buf[4096];
49 	} req;
50 	struct qdisc_util *q = NULL;
51 	struct tc_estimator est;
52 	char  d[16];
53 	char  k[16];
54 
55 	memset(&req, 0, sizeof(req));
56 	memset(&est, 0, sizeof(est));
57 	memset(d, 0, sizeof(d));
58 	memset(k, 0, sizeof(k));
59 
60 	req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct tcmsg));
61 	req.n.nlmsg_flags = NLM_F_REQUEST|flags;
62 	req.n.nlmsg_type = cmd;
63 	req.t.tcm_family = AF_UNSPEC;
64 
65 	while (argc > 0) {
66 		if (strcmp(*argv, "dev") == 0) {
67 			NEXT_ARG();
68 			if (d[0])
69 				duparg("dev", *argv);
70 			strncpy(d, *argv, sizeof(d)-1);
71 		} else if (strcmp(*argv, "classid") == 0) {
72 			__u32 handle;
73 			NEXT_ARG();
74 			if (req.t.tcm_handle)
75 				duparg("classid", *argv);
76 			if (get_tc_classid(&handle, *argv))
77 				invarg(*argv, "invalid class ID");
78 			req.t.tcm_handle = handle;
79 		} else if (strcmp(*argv, "handle") == 0) {
80 			fprintf(stderr, "Error: try \"classid\" instead of \"handle\"\n");
81 			return -1;
82  		} else if (strcmp(*argv, "root") == 0) {
83 			if (req.t.tcm_parent) {
84 				fprintf(stderr, "Error: \"root\" is duplicate parent ID.\n");
85 				return -1;
86 			}
87 			req.t.tcm_parent = TC_H_ROOT;
88 		} else if (strcmp(*argv, "parent") == 0) {
89 			__u32 handle;
90 			NEXT_ARG();
91 			if (req.t.tcm_parent)
92 				duparg("parent", *argv);
93 			if (get_tc_classid(&handle, *argv))
94 				invarg(*argv, "invalid parent ID");
95 			req.t.tcm_parent = handle;
96 		} else if (matches(*argv, "estimator") == 0) {
97 			if (parse_estimator(&argc, &argv, &est))
98 				return -1;
99 		} else if (matches(*argv, "help") == 0) {
100 			usage();
101 		} else {
102 			strncpy(k, *argv, sizeof(k)-1);
103 
104 			q = get_qdisc_kind(k);
105 			argc--; argv++;
106 			break;
107 		}
108 		argc--; argv++;
109 	}
110 
111 	if (k[0])
112 		addattr_l(&req.n, sizeof(req), TCA_KIND, k, strlen(k)+1);
113 	if (est.ewma_log)
114 		addattr_l(&req.n, sizeof(req), TCA_RATE, &est, sizeof(est));
115 
116 	if (q) {
117 		if (q->parse_copt == NULL) {
118 			fprintf(stderr, "Error: Qdisc \"%s\" is classless.\n", k);
119 			return 1;
120 		}
121 		if (q->parse_copt(q, argc, argv, &req.n))
122 			return 1;
123 	} else {
124 		if (argc) {
125 			if (matches(*argv, "help") == 0)
126 				usage();
127 			fprintf(stderr, "Garbage instead of arguments \"%s ...\". Try \"tc class help\".", *argv);
128 			return -1;
129 		}
130 	}
131 
132 	if (d[0])  {
133 		ll_init_map(&rth);
134 
135 		if ((req.t.tcm_ifindex = ll_name_to_index(d)) == 0) {
136 			fprintf(stderr, "Cannot find device \"%s\"\n", d);
137 			return 1;
138 		}
139 	}
140 
141 	if (rtnl_talk(&rth, &req.n, 0, 0, NULL, NULL, NULL) < 0)
142 		return 2;
143 
144 	return 0;
145 }
146 
147 int filter_ifindex;
148 __u32 filter_qdisc;
149 __u32 filter_classid;
150 
print_class(const struct sockaddr_nl * who,struct nlmsghdr * n,void * arg)151 int print_class(const struct sockaddr_nl *who,
152 		       struct nlmsghdr *n, void *arg)
153 {
154 	FILE *fp = (FILE*)arg;
155 	struct tcmsg *t = NLMSG_DATA(n);
156 	int len = n->nlmsg_len;
157 	struct rtattr * tb[TCA_MAX+1];
158 	struct qdisc_util *q;
159 	char abuf[256];
160 
161 	if (n->nlmsg_type != RTM_NEWTCLASS && n->nlmsg_type != RTM_DELTCLASS) {
162 		fprintf(stderr, "Not a class\n");
163 		return 0;
164 	}
165 	len -= NLMSG_LENGTH(sizeof(*t));
166 	if (len < 0) {
167 		fprintf(stderr, "Wrong len %d\n", len);
168 		return -1;
169 	}
170 	if (filter_qdisc && TC_H_MAJ(t->tcm_handle^filter_qdisc))
171 		return 0;
172 
173 	if (filter_classid && t->tcm_handle != filter_classid)
174 		return 0;
175 
176 	memset(tb, 0, sizeof(tb));
177 	parse_rtattr(tb, TCA_MAX, TCA_RTA(t), len);
178 
179 	if (tb[TCA_KIND] == NULL) {
180 		fprintf(stderr, "print_class: NULL kind\n");
181 		return -1;
182 	}
183 
184 	if (n->nlmsg_type == RTM_DELTCLASS)
185 		fprintf(fp, "deleted ");
186 
187 	abuf[0] = 0;
188 	if (t->tcm_handle) {
189 		if (filter_qdisc)
190 			print_tc_classid(abuf, sizeof(abuf), TC_H_MIN(t->tcm_handle));
191 		else
192 			print_tc_classid(abuf, sizeof(abuf), t->tcm_handle);
193 	}
194 	fprintf(fp, "class %s %s ", (char*)RTA_DATA(tb[TCA_KIND]), abuf);
195 
196 	if (filter_ifindex == 0)
197 		fprintf(fp, "dev %s ", ll_index_to_name(t->tcm_ifindex));
198 
199 	if (t->tcm_parent == TC_H_ROOT)
200 		fprintf(fp, "root ");
201 	else {
202 		if (filter_qdisc)
203 			print_tc_classid(abuf, sizeof(abuf), TC_H_MIN(t->tcm_parent));
204 		else
205 			print_tc_classid(abuf, sizeof(abuf), t->tcm_parent);
206 		fprintf(fp, "parent %s ", abuf);
207 	}
208 	if (t->tcm_info)
209 		fprintf(fp, "leaf %x: ", t->tcm_info>>16);
210 	q = get_qdisc_kind(RTA_DATA(tb[TCA_KIND]));
211 	if (tb[TCA_OPTIONS]) {
212 		if (q && q->print_copt)
213 			q->print_copt(q, fp, tb[TCA_OPTIONS]);
214 		else
215 			fprintf(fp, "[cannot parse class parameters]");
216 	}
217 	fprintf(fp, "\n");
218 	if (show_stats) {
219 		struct rtattr *xstats = NULL;
220 
221 		if (tb[TCA_STATS] || tb[TCA_STATS2]) {
222 			print_tcstats_attr(fp, tb, " ", &xstats);
223 			fprintf(fp, "\n");
224 		}
225 		if (q && (xstats || tb[TCA_XSTATS]) && q->print_xstats) {
226 			q->print_xstats(q, fp, xstats ? : tb[TCA_XSTATS]);
227 			fprintf(fp, "\n");
228 		}
229 	}
230 	fflush(fp);
231 	return 0;
232 }
233 
234 
tc_class_list(int argc,char ** argv)235 int tc_class_list(int argc, char **argv)
236 {
237 	struct tcmsg t;
238 	char d[16];
239 
240 	memset(&t, 0, sizeof(t));
241 	t.tcm_family = AF_UNSPEC;
242 	memset(d, 0, sizeof(d));
243 
244 	while (argc > 0) {
245 		if (strcmp(*argv, "dev") == 0) {
246 			NEXT_ARG();
247 			if (d[0])
248 				duparg("dev", *argv);
249 			strncpy(d, *argv, sizeof(d)-1);
250 		} else if (strcmp(*argv, "qdisc") == 0) {
251 			NEXT_ARG();
252 			if (filter_qdisc)
253 				duparg("qdisc", *argv);
254 			if (get_qdisc_handle(&filter_qdisc, *argv))
255 				invarg(*argv, "invalid qdisc ID");
256 		} else if (strcmp(*argv, "classid") == 0) {
257 			NEXT_ARG();
258 			if (filter_classid)
259 				duparg("classid", *argv);
260 			if (get_tc_classid(&filter_classid, *argv))
261 				invarg(*argv, "invalid class ID");
262 		} else if (strcmp(*argv, "root") == 0) {
263 			if (t.tcm_parent) {
264 				fprintf(stderr, "Error: \"root\" is duplicate parent ID\n");
265 				return -1;
266 			}
267 			t.tcm_parent = TC_H_ROOT;
268 		} else if (strcmp(*argv, "parent") == 0) {
269 			__u32 handle;
270 			if (t.tcm_parent)
271 				duparg("parent", *argv);
272 			NEXT_ARG();
273 			if (get_tc_classid(&handle, *argv))
274 				invarg(*argv, "invalid parent ID");
275 			t.tcm_parent = handle;
276 		} else if (matches(*argv, "help") == 0) {
277 			usage();
278 		} else {
279 			fprintf(stderr, "What is \"%s\"? Try \"tc class help\".\n", *argv);
280 			return -1;
281 		}
282 
283 		argc--; argv++;
284 	}
285 
286  	ll_init_map(&rth);
287 
288 	if (d[0]) {
289 		if ((t.tcm_ifindex = ll_name_to_index(d)) == 0) {
290 			fprintf(stderr, "Cannot find device \"%s\"\n", d);
291 			return 1;
292 		}
293 		filter_ifindex = t.tcm_ifindex;
294 	}
295 
296  	if (rtnl_dump_request(&rth, RTM_GETTCLASS, &t, sizeof(t)) < 0) {
297 		perror("Cannot send dump request");
298 		return 1;
299 	}
300 
301  	if (rtnl_dump_filter(&rth, print_class, stdout, NULL, NULL) < 0) {
302 		fprintf(stderr, "Dump terminated\n");
303 		return 1;
304 	}
305 
306 	return 0;
307 }
308 
do_class(int argc,char ** argv)309 int do_class(int argc, char **argv)
310 {
311 	if (argc < 1)
312 		return tc_class_list(0, NULL);
313 	if (matches(*argv, "add") == 0)
314 		return tc_class_modify(RTM_NEWTCLASS, NLM_F_EXCL|NLM_F_CREATE, argc-1, argv+1);
315 	if (matches(*argv, "change") == 0)
316 		return tc_class_modify(RTM_NEWTCLASS, 0, argc-1, argv+1);
317 	if (matches(*argv, "replace") == 0)
318 		return tc_class_modify(RTM_NEWTCLASS, NLM_F_CREATE, argc-1, argv+1);
319 	if (matches(*argv, "delete") == 0)
320 		return tc_class_modify(RTM_DELTCLASS, 0,  argc-1, argv+1);
321 #if 0
322 	if (matches(*argv, "get") == 0)
323 		return tc_class_get(RTM_GETTCLASS, 0,  argc-1, argv+1);
324 #endif
325 	if (matches(*argv, "list") == 0 || matches(*argv, "show") == 0
326 	    || matches(*argv, "lst") == 0)
327 		return tc_class_list(argc-1, argv+1);
328 	if (matches(*argv, "help") == 0) {
329 		usage();
330 		return 0;
331 	}
332 	fprintf(stderr, "Command \"%s\" is unknown, try \"tc class help\".\n", *argv);
333 	return -1;
334 }
335