2 * q_mqprio.c MQ prio qdisc
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.
9 * Author: John Fastabend, <john.r.fastabend@intel.com>
16 #include <sys/socket.h>
17 #include <netinet/in.h>
18 #include <arpa/inet.h>
24 static void explain(void)
26 fprintf(stderr
, "Usage: ... mqprio [num_tc NUMBER] [map P0 P1 ...]\n");
27 fprintf(stderr
, " [queues count1@offset1 count2@offset2 ...] ");
28 fprintf(stderr
, "[hw 1|0]\n");
29 fprintf(stderr
, " [mode dcb|channel]\n");
30 fprintf(stderr
, " [shaper bw_rlimit SHAPER_PARAMS]\n"
31 "Where: SHAPER_PARAMS := { min_rate MIN_RATE1 MIN_RATE2 ...|\n"
32 " max_rate MAX_RATE1 MAX_RATE2 ... }\n");
35 static int mqprio_parse_opt(struct qdisc_util
*qu
, int argc
,
36 char **argv
, struct nlmsghdr
*n
, const char *dev
)
39 struct tc_mqprio_qopt opt
= {
41 .prio_tc_map
= { 0, 1, 2, 3, 4, 5, 6, 7, 0, 1, 1, 1, 3, 3, 3, 3 },
46 __u64 min_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
47 __u64 max_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
48 __u16 shaper
= TC_MQPRIO_SHAPER_DCB
;
49 __u16 mode
= TC_MQPRIO_MODE_DCB
;
55 if (strcmp(*argv
, "num_tc") == 0) {
57 if (get_u8(&opt
.num_tc
, *argv
, 10)) {
58 fprintf(stderr
, "Illegal \"num_tc\"\n");
61 } else if (strcmp(*argv
, "map") == 0) {
62 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
64 if (get_u8(&opt
.prio_tc_map
[idx
], *argv
, 10)) {
70 for ( ; idx
< TC_QOPT_MAX_QUEUE
; idx
++)
71 opt
.prio_tc_map
[idx
] = 0;
72 } else if (strcmp(*argv
, "queues") == 0) {
75 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
82 tok
= strtok(tmp
, "@");
83 if (get_u16(&opt
.count
[idx
], tok
, 10)) {
88 tok
= strtok(NULL
, "@");
89 if (get_u16(&opt
.offset
[idx
], tok
, 10)) {
97 } else if (strcmp(*argv
, "hw") == 0) {
99 if (get_u8(&opt
.hw
, *argv
, 10)) {
100 fprintf(stderr
, "Illegal \"hw\"\n");
104 } else if (opt
.hw
&& strcmp(*argv
, "mode") == 0) {
106 if (matches(*argv
, "dcb") == 0) {
107 mode
= TC_MQPRIO_MODE_DCB
;
108 } else if (matches(*argv
, "channel") == 0) {
109 mode
= TC_MQPRIO_MODE_CHANNEL
;
111 fprintf(stderr
, "Illegal mode (%s)\n",
115 if (mode
!= TC_MQPRIO_MODE_DCB
)
116 flags
|= TC_MQPRIO_F_MODE
;
118 } else if (opt
.hw
&& strcmp(*argv
, "shaper") == 0) {
120 if (matches(*argv
, "dcb") == 0) {
121 shaper
= TC_MQPRIO_SHAPER_DCB
;
122 } else if (matches(*argv
, "bw_rlimit") == 0) {
123 shaper
= TC_MQPRIO_SHAPER_BW_RATE
;
124 if (!NEXT_ARG_OK()) {
125 fprintf(stderr
, "Incomplete shaper arguments\n");
129 fprintf(stderr
, "Illegal shaper (%s)\n",
133 if (shaper
!= TC_MQPRIO_SHAPER_DCB
)
134 flags
|= TC_MQPRIO_F_SHAPER
;
136 } else if ((shaper
== TC_MQPRIO_SHAPER_BW_RATE
) &&
137 strcmp(*argv
, "min_rate") == 0) {
138 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
140 if (get_rate64(&min_rate64
[idx
], *argv
)) {
146 if (idx
< opt
.num_tc
&& !NEXT_ARG_OK()) {
147 fprintf(stderr
, "Incomplete arguments, min_rate values expected\n");
150 flags
|= TC_MQPRIO_F_MIN_RATE
;
151 } else if ((shaper
== TC_MQPRIO_SHAPER_BW_RATE
) &&
152 strcmp(*argv
, "max_rate") == 0) {
153 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
155 if (get_rate64(&max_rate64
[idx
], *argv
)) {
161 if (idx
< opt
.num_tc
&& !NEXT_ARG_OK()) {
162 fprintf(stderr
, "Incomplete arguments, max_rate values expected\n");
165 flags
|= TC_MQPRIO_F_MAX_RATE
;
166 } else if (strcmp(*argv
, "help") == 0) {
170 fprintf(stderr
, "Unknown argument\n");
176 tail
= NLMSG_TAIL(n
);
177 addattr_l(n
, 1024, TCA_OPTIONS
, &opt
, sizeof(opt
));
179 if (flags
& TC_MQPRIO_F_MODE
)
180 addattr_l(n
, 1024, TCA_MQPRIO_MODE
,
181 &mode
, sizeof(mode
));
182 if (flags
& TC_MQPRIO_F_SHAPER
)
183 addattr_l(n
, 1024, TCA_MQPRIO_SHAPER
,
184 &shaper
, sizeof(shaper
));
186 if (flags
& TC_MQPRIO_F_MIN_RATE
) {
187 struct rtattr
*start
;
189 start
= addattr_nest(n
, 1024,
190 TCA_MQPRIO_MIN_RATE64
| NLA_F_NESTED
);
192 for (idx
= 0; idx
< TC_QOPT_MAX_QUEUE
; idx
++)
193 addattr_l(n
, 1024, TCA_MQPRIO_MIN_RATE64
,
194 &min_rate64
[idx
], sizeof(min_rate64
[idx
]));
196 addattr_nest_end(n
, start
);
199 if (flags
& TC_MQPRIO_F_MAX_RATE
) {
200 struct rtattr
*start
;
202 start
= addattr_nest(n
, 1024,
203 TCA_MQPRIO_MAX_RATE64
| NLA_F_NESTED
);
205 for (idx
= 0; idx
< TC_QOPT_MAX_QUEUE
; idx
++)
206 addattr_l(n
, 1024, TCA_MQPRIO_MAX_RATE64
,
207 &max_rate64
[idx
], sizeof(max_rate64
[idx
]));
209 addattr_nest_end(n
, start
);
212 tail
->rta_len
= (void *)NLMSG_TAIL(n
) - (void *)tail
;
217 static int mqprio_print_opt(struct qdisc_util
*qu
, FILE *f
, struct rtattr
*opt
)
220 struct tc_mqprio_qopt
*qopt
;
221 __u64 min_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
222 __u64 max_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
230 len
= RTA_PAYLOAD(opt
) - RTA_ALIGN(sizeof(*qopt
));
232 fprintf(stderr
, "options size error\n");
236 qopt
= RTA_DATA(opt
);
238 fprintf(f
, " tc %u map ", qopt
->num_tc
);
239 for (i
= 0; i
<= TC_PRIO_MAX
; i
++)
240 fprintf(f
, "%u ", qopt
->prio_tc_map
[i
]);
241 fprintf(f
, "\n queues:");
242 for (i
= 0; i
< qopt
->num_tc
; i
++)
243 fprintf(f
, "(%u:%u) ", qopt
->offset
[i
],
244 qopt
->offset
[i
] + qopt
->count
[i
] - 1);
247 struct rtattr
*tb
[TCA_MQPRIO_MAX
+ 1];
249 parse_rtattr(tb
, TCA_MQPRIO_MAX
,
250 RTA_DATA(opt
) + RTA_ALIGN(sizeof(*qopt
)),
253 if (tb
[TCA_MQPRIO_MODE
]) {
254 __u16
*mode
= RTA_DATA(tb
[TCA_MQPRIO_MODE
]);
256 if (*mode
== TC_MQPRIO_MODE_CHANNEL
)
257 fprintf(f
, "\n mode:channel");
259 fprintf(f
, "\n mode:dcb");
262 if (tb
[TCA_MQPRIO_SHAPER
]) {
263 __u16
*shaper
= RTA_DATA(tb
[TCA_MQPRIO_SHAPER
]);
265 if (*shaper
== TC_MQPRIO_SHAPER_BW_RATE
)
266 fprintf(f
, "\n shaper:bw_rlimit");
268 fprintf(f
, "\n shaper:dcb");
271 if (tb
[TCA_MQPRIO_MIN_RATE64
]) {
273 int rem
= RTA_PAYLOAD(tb
[TCA_MQPRIO_MIN_RATE64
]);
274 __u64
*min
= min_rate64
;
276 for (r
= RTA_DATA(tb
[TCA_MQPRIO_MIN_RATE64
]);
277 RTA_OK(r
, rem
); r
= RTA_NEXT(r
, rem
)) {
278 if (r
->rta_type
!= TCA_MQPRIO_MIN_RATE64
)
280 *(min
++) = rta_getattr_u64(r
);
282 fprintf(f
, " min_rate:");
283 for (i
= 0; i
< qopt
->num_tc
; i
++)
284 fprintf(f
, "%s ", sprint_rate(min_rate64
[i
], b1
));
287 if (tb
[TCA_MQPRIO_MAX_RATE64
]) {
289 int rem
= RTA_PAYLOAD(tb
[TCA_MQPRIO_MAX_RATE64
]);
290 __u64
*max
= max_rate64
;
292 for (r
= RTA_DATA(tb
[TCA_MQPRIO_MAX_RATE64
]);
293 RTA_OK(r
, rem
); r
= RTA_NEXT(r
, rem
)) {
294 if (r
->rta_type
!= TCA_MQPRIO_MAX_RATE64
)
296 *(max
++) = rta_getattr_u64(r
);
298 fprintf(f
, " max_rate:");
299 for (i
= 0; i
< qopt
->num_tc
; i
++)
300 fprintf(f
, "%s ", sprint_rate(max_rate64
[i
], b1
));
306 struct qdisc_util mqprio_qdisc_util
= {
308 .parse_qopt
= mqprio_parse_opt
,
309 .print_qopt
= mqprio_print_opt
,