|
Packit |
d3f73b |
/*
|
|
Packit |
d3f73b |
* q_mqprio.c MQ prio qdisc
|
|
Packit |
d3f73b |
*
|
|
Packit |
d3f73b |
* This program is free software; you can redistribute it and/or
|
|
Packit |
d3f73b |
* modify it under the terms of the GNU General Public License
|
|
Packit |
d3f73b |
* as published by the Free Software Foundation; either version
|
|
Packit |
d3f73b |
* 2 of the License, or (at your option) any later version.
|
|
Packit |
d3f73b |
*
|
|
Packit |
d3f73b |
* Author: John Fastabend, <john.r.fastabend@intel.com>
|
|
Packit |
d3f73b |
*/
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
#include <stdio.h>
|
|
Packit |
d3f73b |
#include <stdlib.h>
|
|
Packit |
d3f73b |
#include <unistd.h>
|
|
Packit |
d3f73b |
#include <fcntl.h>
|
|
Packit |
d3f73b |
#include <sys/socket.h>
|
|
Packit |
d3f73b |
#include <netinet/in.h>
|
|
Packit |
d3f73b |
#include <arpa/inet.h>
|
|
Packit |
d3f73b |
#include <string.h>
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
#include "utils.h"
|
|
Packit |
d3f73b |
#include "tc_util.h"
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static void explain(void)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
fprintf(stderr,
|
|
Packit |
d3f73b |
"Usage: ... mqprio [num_tc NUMBER] [map P0 P1 ...]\n"
|
|
Packit |
d3f73b |
" [queues count1@offset1 count2@offset2 ...] "
|
|
Packit |
d3f73b |
"[hw 1|0]\n"
|
|
Packit |
d3f73b |
" [mode dcb|channel]\n"
|
|
Packit |
d3f73b |
" [shaper bw_rlimit SHAPER_PARAMS]\n"
|
|
Packit |
d3f73b |
"Where: SHAPER_PARAMS := { min_rate MIN_RATE1 MIN_RATE2 ...|\n"
|
|
Packit |
d3f73b |
" max_rate MAX_RATE1 MAX_RATE2 ... }\n");
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static int mqprio_parse_opt(struct qdisc_util *qu, int argc,
|
|
Packit |
d3f73b |
char **argv, struct nlmsghdr *n, const char *dev)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
int idx;
|
|
Packit |
d3f73b |
struct tc_mqprio_qopt opt = {
|
|
Packit |
d3f73b |
.num_tc = 8,
|
|
Packit |
d3f73b |
.prio_tc_map = { 0, 1, 2, 3, 4, 5, 6, 7, 0, 1, 1, 1, 3, 3, 3, 3 },
|
|
Packit |
d3f73b |
.hw = 1,
|
|
Packit |
d3f73b |
.count = { },
|
|
Packit |
d3f73b |
.offset = { },
|
|
Packit |
d3f73b |
};
|
|
Packit |
d3f73b |
__u64 min_rate64[TC_QOPT_MAX_QUEUE] = {0};
|
|
Packit |
d3f73b |
__u64 max_rate64[TC_QOPT_MAX_QUEUE] = {0};
|
|
Packit |
d3f73b |
__u16 shaper = TC_MQPRIO_SHAPER_DCB;
|
|
Packit |
d3f73b |
__u16 mode = TC_MQPRIO_MODE_DCB;
|
|
Packit |
d3f73b |
struct rtattr *tail;
|
|
Packit |
d3f73b |
__u32 flags = 0;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
while (argc > 0) {
|
|
Packit |
d3f73b |
idx = 0;
|
|
Packit |
d3f73b |
if (strcmp(*argv, "num_tc") == 0) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (get_u8(&opt.num_tc, *argv, 10)) {
|
|
Packit |
d3f73b |
fprintf(stderr, "Illegal \"num_tc\"\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
} else if (strcmp(*argv, "map") == 0) {
|
|
Packit |
d3f73b |
while (idx < TC_QOPT_MAX_QUEUE && NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (get_u8(&opt.prio_tc_map[idx], *argv, 10)) {
|
|
Packit |
d3f73b |
PREV_ARG();
|
|
Packit |
d3f73b |
break;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
for ( ; idx < TC_QOPT_MAX_QUEUE; idx++)
|
|
Packit |
d3f73b |
opt.prio_tc_map[idx] = 0;
|
|
Packit |
d3f73b |
} else if (strcmp(*argv, "queues") == 0) {
|
|
Packit |
d3f73b |
char *tmp, *tok;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
while (idx < TC_QOPT_MAX_QUEUE && NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
tmp = strdup(*argv);
|
|
Packit |
d3f73b |
if (!tmp)
|
|
Packit |
d3f73b |
break;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
tok = strtok(tmp, "@");
|
|
Packit |
d3f73b |
if (get_u16(&opt.count[idx], tok, 10)) {
|
|
Packit |
d3f73b |
free(tmp);
|
|
Packit |
d3f73b |
PREV_ARG();
|
|
Packit |
d3f73b |
break;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
tok = strtok(NULL, "@");
|
|
Packit |
d3f73b |
if (get_u16(&opt.offset[idx], tok, 10)) {
|
|
Packit |
d3f73b |
free(tmp);
|
|
Packit |
d3f73b |
PREV_ARG();
|
|
Packit |
d3f73b |
break;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
free(tmp);
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
} else if (strcmp(*argv, "hw") == 0) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (get_u8(&opt.hw, *argv, 10)) {
|
|
Packit |
d3f73b |
fprintf(stderr, "Illegal \"hw\"\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
} else if (opt.hw && strcmp(*argv, "mode") == 0) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (matches(*argv, "dcb") == 0) {
|
|
Packit |
d3f73b |
mode = TC_MQPRIO_MODE_DCB;
|
|
Packit |
d3f73b |
} else if (matches(*argv, "channel") == 0) {
|
|
Packit |
d3f73b |
mode = TC_MQPRIO_MODE_CHANNEL;
|
|
Packit |
d3f73b |
} else {
|
|
Packit |
d3f73b |
fprintf(stderr, "Illegal mode (%s)\n",
|
|
Packit |
d3f73b |
*argv);
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
if (mode != TC_MQPRIO_MODE_DCB)
|
|
Packit |
d3f73b |
flags |= TC_MQPRIO_F_MODE;
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
} else if (opt.hw && strcmp(*argv, "shaper") == 0) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (matches(*argv, "dcb") == 0) {
|
|
Packit |
d3f73b |
shaper = TC_MQPRIO_SHAPER_DCB;
|
|
Packit |
d3f73b |
} else if (matches(*argv, "bw_rlimit") == 0) {
|
|
Packit |
d3f73b |
shaper = TC_MQPRIO_SHAPER_BW_RATE;
|
|
Packit |
d3f73b |
if (!NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
fprintf(stderr, "Incomplete shaper arguments\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
} else {
|
|
Packit |
d3f73b |
fprintf(stderr, "Illegal shaper (%s)\n",
|
|
Packit |
d3f73b |
*argv);
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
if (shaper != TC_MQPRIO_SHAPER_DCB)
|
|
Packit |
d3f73b |
flags |= TC_MQPRIO_F_SHAPER;
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
} else if ((shaper == TC_MQPRIO_SHAPER_BW_RATE) &&
|
|
Packit |
d3f73b |
strcmp(*argv, "min_rate") == 0) {
|
|
Packit |
d3f73b |
while (idx < TC_QOPT_MAX_QUEUE && NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (get_rate64(&min_rate64[idx], *argv)) {
|
|
Packit |
d3f73b |
PREV_ARG();
|
|
Packit |
d3f73b |
break;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
if (idx < opt.num_tc && !NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
fprintf(stderr, "Incomplete arguments, min_rate values expected\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
flags |= TC_MQPRIO_F_MIN_RATE;
|
|
Packit |
d3f73b |
} else if ((shaper == TC_MQPRIO_SHAPER_BW_RATE) &&
|
|
Packit |
d3f73b |
strcmp(*argv, "max_rate") == 0) {
|
|
Packit |
d3f73b |
while (idx < TC_QOPT_MAX_QUEUE && NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
NEXT_ARG();
|
|
Packit |
d3f73b |
if (get_rate64(&max_rate64[idx], *argv)) {
|
|
Packit |
d3f73b |
PREV_ARG();
|
|
Packit |
d3f73b |
break;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
idx++;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
if (idx < opt.num_tc && !NEXT_ARG_OK()) {
|
|
Packit |
d3f73b |
fprintf(stderr, "Incomplete arguments, max_rate values expected\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
flags |= TC_MQPRIO_F_MAX_RATE;
|
|
Packit |
d3f73b |
} else if (strcmp(*argv, "help") == 0) {
|
|
Packit |
d3f73b |
explain();
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
} else {
|
|
Packit |
d3f73b |
invarg("unknown argument", *argv);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
argc--; argv++;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
tail = NLMSG_TAIL(n);
|
|
Packit |
d3f73b |
addattr_l(n, 1024, TCA_OPTIONS, &opt, sizeof(opt));
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (flags & TC_MQPRIO_F_MODE)
|
|
Packit |
d3f73b |
addattr_l(n, 1024, TCA_MQPRIO_MODE,
|
|
Packit |
d3f73b |
&mode, sizeof(mode));
|
|
Packit |
d3f73b |
if (flags & TC_MQPRIO_F_SHAPER)
|
|
Packit |
d3f73b |
addattr_l(n, 1024, TCA_MQPRIO_SHAPER,
|
|
Packit |
d3f73b |
&shaper, sizeof(shaper));
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (flags & TC_MQPRIO_F_MIN_RATE) {
|
|
Packit |
d3f73b |
struct rtattr *start;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
start = addattr_nest(n, 1024,
|
|
Packit |
d3f73b |
TCA_MQPRIO_MIN_RATE64 | NLA_F_NESTED);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
for (idx = 0; idx < TC_QOPT_MAX_QUEUE; idx++)
|
|
Packit |
d3f73b |
addattr_l(n, 1024, TCA_MQPRIO_MIN_RATE64,
|
|
Packit |
d3f73b |
&min_rate64[idx], sizeof(min_rate64[idx]));
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
addattr_nest_end(n, start);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (flags & TC_MQPRIO_F_MAX_RATE) {
|
|
Packit |
d3f73b |
struct rtattr *start;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
start = addattr_nest(n, 1024,
|
|
Packit |
d3f73b |
TCA_MQPRIO_MAX_RATE64 | NLA_F_NESTED);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
for (idx = 0; idx < TC_QOPT_MAX_QUEUE; idx++)
|
|
Packit |
d3f73b |
addattr_l(n, 1024, TCA_MQPRIO_MAX_RATE64,
|
|
Packit |
d3f73b |
&max_rate64[idx], sizeof(max_rate64[idx]));
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
addattr_nest_end(n, start);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
tail->rta_len = (void *)NLMSG_TAIL(n) - (void *)tail;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
static int mqprio_print_opt(struct qdisc_util *qu, FILE *f, struct rtattr *opt)
|
|
Packit |
d3f73b |
{
|
|
Packit |
d3f73b |
int i;
|
|
Packit |
d3f73b |
struct tc_mqprio_qopt *qopt;
|
|
Packit |
d3f73b |
__u64 min_rate64[TC_QOPT_MAX_QUEUE] = {0};
|
|
Packit |
d3f73b |
__u64 max_rate64[TC_QOPT_MAX_QUEUE] = {0};
|
|
Packit |
d3f73b |
int len;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
SPRINT_BUF(b1);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (opt == NULL)
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
len = RTA_PAYLOAD(opt) - RTA_ALIGN(sizeof(*qopt));
|
|
Packit |
d3f73b |
if (len < 0) {
|
|
Packit |
d3f73b |
fprintf(stderr, "options size error\n");
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
qopt = RTA_DATA(opt);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
fprintf(f, " tc %u map ", qopt->num_tc);
|
|
Packit |
d3f73b |
for (i = 0; i <= TC_PRIO_MAX; i++)
|
|
Packit |
d3f73b |
fprintf(f, "%u ", qopt->prio_tc_map[i]);
|
|
Packit |
d3f73b |
fprintf(f, "\n queues:");
|
|
Packit |
d3f73b |
for (i = 0; i < qopt->num_tc; i++)
|
|
Packit |
d3f73b |
fprintf(f, "(%u:%u) ", qopt->offset[i],
|
|
Packit |
d3f73b |
qopt->offset[i] + qopt->count[i] - 1);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (len > 0) {
|
|
Packit |
d3f73b |
struct rtattr *tb[TCA_MQPRIO_MAX + 1];
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
parse_rtattr(tb, TCA_MQPRIO_MAX,
|
|
Packit |
d3f73b |
RTA_DATA(opt) + RTA_ALIGN(sizeof(*qopt)),
|
|
Packit |
d3f73b |
len);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (tb[TCA_MQPRIO_MODE]) {
|
|
Packit |
d3f73b |
__u16 *mode = RTA_DATA(tb[TCA_MQPRIO_MODE]);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (*mode == TC_MQPRIO_MODE_CHANNEL)
|
|
Packit |
d3f73b |
fprintf(f, "\n mode:channel");
|
|
Packit |
d3f73b |
} else {
|
|
Packit |
d3f73b |
fprintf(f, "\n mode:dcb");
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (tb[TCA_MQPRIO_SHAPER]) {
|
|
Packit |
d3f73b |
__u16 *shaper = RTA_DATA(tb[TCA_MQPRIO_SHAPER]);
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (*shaper == TC_MQPRIO_SHAPER_BW_RATE)
|
|
Packit |
d3f73b |
fprintf(f, "\n shaper:bw_rlimit");
|
|
Packit |
d3f73b |
} else {
|
|
Packit |
d3f73b |
fprintf(f, "\n shaper:dcb");
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (tb[TCA_MQPRIO_MIN_RATE64]) {
|
|
Packit |
d3f73b |
struct rtattr *r;
|
|
Packit |
d3f73b |
int rem = RTA_PAYLOAD(tb[TCA_MQPRIO_MIN_RATE64]);
|
|
Packit |
d3f73b |
__u64 *min = min_rate64;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
for (r = RTA_DATA(tb[TCA_MQPRIO_MIN_RATE64]);
|
|
Packit |
d3f73b |
RTA_OK(r, rem); r = RTA_NEXT(r, rem)) {
|
|
Packit |
d3f73b |
if (r->rta_type != TCA_MQPRIO_MIN_RATE64)
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
*(min++) = rta_getattr_u64(r);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
fprintf(f, " min_rate:");
|
|
Packit |
d3f73b |
for (i = 0; i < qopt->num_tc; i++)
|
|
Packit |
d3f73b |
fprintf(f, "%s ", sprint_rate(min_rate64[i], b1));
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
if (tb[TCA_MQPRIO_MAX_RATE64]) {
|
|
Packit |
d3f73b |
struct rtattr *r;
|
|
Packit |
d3f73b |
int rem = RTA_PAYLOAD(tb[TCA_MQPRIO_MAX_RATE64]);
|
|
Packit |
d3f73b |
__u64 *max = max_rate64;
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
for (r = RTA_DATA(tb[TCA_MQPRIO_MAX_RATE64]);
|
|
Packit |
d3f73b |
RTA_OK(r, rem); r = RTA_NEXT(r, rem)) {
|
|
Packit |
d3f73b |
if (r->rta_type != TCA_MQPRIO_MAX_RATE64)
|
|
Packit |
d3f73b |
return -1;
|
|
Packit |
d3f73b |
*(max++) = rta_getattr_u64(r);
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
fprintf(f, " max_rate:");
|
|
Packit |
d3f73b |
for (i = 0; i < qopt->num_tc; i++)
|
|
Packit |
d3f73b |
fprintf(f, "%s ", sprint_rate(max_rate64[i], b1));
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
return 0;
|
|
Packit |
d3f73b |
}
|
|
Packit |
d3f73b |
|
|
Packit |
d3f73b |
struct qdisc_util mqprio_qdisc_util = {
|
|
Packit |
d3f73b |
.id = "mqprio",
|
|
Packit |
d3f73b |
.parse_qopt = mqprio_parse_opt,
|
|
Packit |
d3f73b |
.print_qopt = mqprio_print_opt,
|
|
Packit |
d3f73b |
};
|