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>
17 #include <sys/socket.h>
18 #include <netinet/in.h>
19 #include <arpa/inet.h>
25 static void explain(void)
27 fprintf(stderr
, "Usage: ... mqprio [num_tc NUMBER] [map P0 P1 ...]\n");
28 fprintf(stderr
, " [queues count1@offset1 count2@offset2 ...] ");
29 fprintf(stderr
, "[hw 1|0]\n");
30 fprintf(stderr
, " [mode dcb|channel]\n");
31 fprintf(stderr
, " [shaper bw_rlimit SHAPER_PARAMS]\n"
32 "Where: SHAPER_PARAMS := { min_rate MIN_RATE1 MIN_RATE2 ...|\n"
33 " max_rate MAX_RATE1 MAX_RATE2 ... }\n");
36 static int mqprio_parse_opt(struct qdisc_util
*qu
, int argc
,
37 char **argv
, struct nlmsghdr
*n
)
40 struct tc_mqprio_qopt opt
= {
42 .prio_tc_map
= { 0, 1, 2, 3, 4, 5, 6, 7, 0, 1, 1, 1, 3, 3, 3, 3 },
47 __u64 min_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
48 __u64 max_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
49 __u16 shaper
= TC_MQPRIO_SHAPER_DCB
;
50 __u16 mode
= TC_MQPRIO_MODE_DCB
;
56 if (strcmp(*argv
, "num_tc") == 0) {
58 if (get_u8(&opt
.num_tc
, *argv
, 10)) {
59 fprintf(stderr
, "Illegal \"num_tc\"\n");
62 } else if (strcmp(*argv
, "map") == 0) {
63 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
65 if (get_u8(&opt
.prio_tc_map
[idx
], *argv
, 10)) {
71 for ( ; idx
< TC_QOPT_MAX_QUEUE
; idx
++)
72 opt
.prio_tc_map
[idx
] = 0;
73 } else if (strcmp(*argv
, "queues") == 0) {
76 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
83 tok
= strtok(tmp
, "@");
84 if (get_u16(&opt
.count
[idx
], tok
, 10)) {
89 tok
= strtok(NULL
, "@");
90 if (get_u16(&opt
.offset
[idx
], tok
, 10)) {
98 } else if (strcmp(*argv
, "hw") == 0) {
100 if (get_u8(&opt
.hw
, *argv
, 10)) {
101 fprintf(stderr
, "Illegal \"hw\"\n");
105 } else if (opt
.hw
&& strcmp(*argv
, "mode") == 0) {
107 if (matches(*argv
, "dcb") == 0) {
108 mode
= TC_MQPRIO_MODE_DCB
;
109 } else if (matches(*argv
, "channel") == 0) {
110 mode
= TC_MQPRIO_MODE_CHANNEL
;
112 fprintf(stderr
, "Illegal mode (%s)\n",
116 if (mode
!= TC_MQPRIO_MODE_DCB
)
117 flags
|= TC_MQPRIO_F_MODE
;
119 } else if (opt
.hw
&& strcmp(*argv
, "shaper") == 0) {
121 if (matches(*argv
, "dcb") == 0) {
122 shaper
= TC_MQPRIO_SHAPER_DCB
;
123 } else if (matches(*argv
, "bw_rlimit") == 0) {
124 shaper
= TC_MQPRIO_SHAPER_BW_RATE
;
125 if (!NEXT_ARG_OK()) {
126 fprintf(stderr
, "Incomplete shaper arguments\n");
130 fprintf(stderr
, "Illegal shaper (%s)\n",
134 if (shaper
!= TC_MQPRIO_SHAPER_DCB
)
135 flags
|= TC_MQPRIO_F_SHAPER
;
137 } else if ((shaper
== TC_MQPRIO_SHAPER_BW_RATE
) &&
138 strcmp(*argv
, "min_rate") == 0) {
139 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
141 if (get_rate64(&min_rate64
[idx
], *argv
)) {
147 if (idx
< opt
.num_tc
&& !NEXT_ARG_OK()) {
148 fprintf(stderr
, "Incomplete arguments, min_rate values expected\n");
151 flags
|= TC_MQPRIO_F_MIN_RATE
;
152 } else if ((shaper
== TC_MQPRIO_SHAPER_BW_RATE
) &&
153 strcmp(*argv
, "max_rate") == 0) {
154 while (idx
< TC_QOPT_MAX_QUEUE
&& NEXT_ARG_OK()) {
156 if (get_rate64(&max_rate64
[idx
], *argv
)) {
162 if (idx
< opt
.num_tc
&& !NEXT_ARG_OK()) {
163 fprintf(stderr
, "Incomplete arguments, max_rate values expected\n");
166 flags
|= TC_MQPRIO_F_MAX_RATE
;
167 } else if (strcmp(*argv
, "help") == 0) {
171 fprintf(stderr
, "Unknown argument\n");
177 tail
= NLMSG_TAIL(n
);
178 addattr_l(n
, 1024, TCA_OPTIONS
, &opt
, sizeof(opt
));
180 if (flags
& TC_MQPRIO_F_MODE
)
181 addattr_l(n
, 1024, TCA_MQPRIO_MODE
,
182 &mode
, sizeof(mode
));
183 if (flags
& TC_MQPRIO_F_SHAPER
)
184 addattr_l(n
, 1024, TCA_MQPRIO_SHAPER
,
185 &shaper
, sizeof(shaper
));
187 if (flags
& TC_MQPRIO_F_MIN_RATE
) {
188 struct rtattr
*start
;
190 start
= addattr_nest(n
, 1024,
191 TCA_MQPRIO_MIN_RATE64
| NLA_F_NESTED
);
193 for (idx
= 0; idx
< TC_QOPT_MAX_QUEUE
; idx
++)
194 addattr_l(n
, 1024, TCA_MQPRIO_MIN_RATE64
,
195 &min_rate64
[idx
], sizeof(min_rate64
[idx
]));
197 addattr_nest_end(n
, start
);
200 if (flags
& TC_MQPRIO_F_MAX_RATE
) {
201 struct rtattr
*start
;
203 start
= addattr_nest(n
, 1024,
204 TCA_MQPRIO_MAX_RATE64
| NLA_F_NESTED
);
206 for (idx
= 0; idx
< TC_QOPT_MAX_QUEUE
; idx
++)
207 addattr_l(n
, 1024, TCA_MQPRIO_MAX_RATE64
,
208 &max_rate64
[idx
], sizeof(max_rate64
[idx
]));
210 addattr_nest_end(n
, start
);
213 tail
->rta_len
= (void *)NLMSG_TAIL(n
) - (void *)tail
;
218 static int mqprio_print_opt(struct qdisc_util
*qu
, FILE *f
, struct rtattr
*opt
)
221 struct tc_mqprio_qopt
*qopt
;
222 __u64 min_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
223 __u64 max_rate64
[TC_QOPT_MAX_QUEUE
] = {0};
231 len
= RTA_PAYLOAD(opt
) - RTA_ALIGN(sizeof(*qopt
));
233 fprintf(stderr
, "options size error\n");
237 qopt
= RTA_DATA(opt
);
239 fprintf(f
, " tc %u map ", qopt
->num_tc
);
240 for (i
= 0; i
<= TC_PRIO_MAX
; i
++)
241 fprintf(f
, "%u ", qopt
->prio_tc_map
[i
]);
242 fprintf(f
, "\n queues:");
243 for (i
= 0; i
< qopt
->num_tc
; i
++)
244 fprintf(f
, "(%u:%u) ", qopt
->offset
[i
],
245 qopt
->offset
[i
] + qopt
->count
[i
] - 1);
248 struct rtattr
*tb
[TCA_MQPRIO_MAX
+ 1];
250 parse_rtattr(tb
, TCA_MQPRIO_MAX
,
251 RTA_DATA(opt
) + RTA_ALIGN(sizeof(*qopt
)),
254 if (tb
[TCA_MQPRIO_MODE
]) {
255 __u16
*mode
= RTA_DATA(tb
[TCA_MQPRIO_MODE
]);
257 if (*mode
== TC_MQPRIO_MODE_CHANNEL
)
258 fprintf(f
, "\n mode:channel");
260 fprintf(f
, "\n mode:dcb");
263 if (tb
[TCA_MQPRIO_SHAPER
]) {
264 __u16
*shaper
= RTA_DATA(tb
[TCA_MQPRIO_SHAPER
]);
266 if (*shaper
== TC_MQPRIO_SHAPER_BW_RATE
)
267 fprintf(f
, "\n shaper:bw_rlimit");
269 fprintf(f
, "\n shaper:dcb");
272 if (tb
[TCA_MQPRIO_MIN_RATE64
]) {
274 int rem
= RTA_PAYLOAD(tb
[TCA_MQPRIO_MIN_RATE64
]);
275 __u64
*min
= min_rate64
;
277 for (r
= RTA_DATA(tb
[TCA_MQPRIO_MIN_RATE64
]);
278 RTA_OK(r
, rem
); r
= RTA_NEXT(r
, rem
)) {
279 if (r
->rta_type
!= TCA_MQPRIO_MIN_RATE64
)
281 *(min
++) = rta_getattr_u64(r
);
283 fprintf(f
, " min_rate:");
284 for (i
= 0; i
< qopt
->num_tc
; i
++)
285 fprintf(f
, "%s ", sprint_rate(min_rate64
[i
], b1
));
288 if (tb
[TCA_MQPRIO_MAX_RATE64
]) {
290 int rem
= RTA_PAYLOAD(tb
[TCA_MQPRIO_MAX_RATE64
]);
291 __u64
*max
= max_rate64
;
293 for (r
= RTA_DATA(tb
[TCA_MQPRIO_MAX_RATE64
]);
294 RTA_OK(r
, rem
); r
= RTA_NEXT(r
, rem
)) {
295 if (r
->rta_type
!= TCA_MQPRIO_MAX_RATE64
)
297 *(max
++) = rta_getattr_u64(r
);
299 fprintf(f
, " max_rate:");
300 for (i
= 0; i
< qopt
->num_tc
; i
++)
301 fprintf(f
, "%s ", sprint_rate(max_rate64
[i
], b1
));
307 struct qdisc_util mqprio_qdisc_util
= {
309 .parse_qopt
= mqprio_parse_opt
,
310 .print_qopt
= mqprio_print_opt
,