8#include <netlink/netlink.h>
9#include <netlink/utils.h>
10#include <netlink/route/qdisc.h>
11#include <netlink/route/qdisc/mqprio.h>
18 uint8_t qm_prio_map[TC_QOPT_BITMASK + 1];
20 uint16_t qm_count[TC_QOPT_MAX_QUEUE];
21 uint16_t qm_offset[TC_QOPT_MAX_QUEUE];
24 uint64_t qm_min_rate[TC_QOPT_MAX_QUEUE];
25 uint64_t qm_max_rate[TC_QOPT_MAX_QUEUE];
29#define SCH_MQPRIO_ATTR_NUMTC (1 << 0)
30#define SCH_MQPRIO_ATTR_PRIOMAP (1 << 1)
31#define SCH_MQPRIO_ATTR_HW (1 << 2)
32#define SCH_MQPRIO_ATTR_QUEUE (1 << 3)
33#define SCH_MQPRIO_ATTR_MODE (1 << 4)
34#define SCH_MQPRIO_ATTR_SHAPER (1 << 5)
35#define SCH_MQPRIO_ATTR_MIN_RATE (1 << 6)
36#define SCH_MQPRIO_ATTR_MAX_RATE (1 << 7)
46static int mqprio_msg_parser(
struct rtnl_tc *tc,
void *data)
48 struct rtnl_mqprio *mqprio = data;
49 struct tc_mqprio_qopt *qopt;
53 if (tc->tc_opts->d_size <
sizeof(*qopt))
56 qopt = (
struct tc_mqprio_qopt *) tc->tc_opts->d_data;
57 mqprio->qm_num_tc = qopt->num_tc;
58 mqprio->qm_hw = qopt->hw;
59 memcpy(mqprio->qm_prio_map, qopt->prio_tc_map,
60 TC_QOPT_MAX_QUEUE *
sizeof(uint8_t));
61 memcpy(mqprio->qm_count, qopt->count,
62 TC_QOPT_MAX_QUEUE *
sizeof(uint16_t));
63 memcpy(mqprio->qm_offset, qopt->offset,
64 TC_QOPT_MAX_QUEUE *
sizeof(uint16_t));
65 mqprio->qm_mask = (SCH_MQPRIO_ATTR_NUMTC | SCH_MQPRIO_ATTR_PRIOMAP |
66 SCH_MQPRIO_ATTR_QUEUE | SCH_MQPRIO_ATTR_HW);
68 len = tc->tc_opts->d_size - NLA_ALIGN(
sizeof(*qopt));
71 struct nlattr *tb[TCA_MQPRIO_MAX + 1];
73 err =
nla_parse(tb, TCA_MQPRIO_MAX, (
struct nlattr *)
74 ((
char *) tc->tc_opts->d_data + NLA_ALIGN(
sizeof(*qopt))),
79 if (tb[TCA_MQPRIO_MODE]) {
81 mqprio->qm_mask |= SCH_MQPRIO_ATTR_MODE;
84 if (tb[TCA_MQPRIO_SHAPER]) {
85 mqprio->qm_shaper =
nla_get_u16(tb[TCA_MQPRIO_SHAPER]);
86 mqprio->qm_mask |= SCH_MQPRIO_ATTR_SHAPER;
89 if (tb[TCA_MQPRIO_MIN_RATE64]) {
92 if (
nla_type(attr) != TCA_MQPRIO_MIN_RATE64)
95 if (i >= mqprio->qm_num_tc)
101 mqprio->qm_mask |= SCH_MQPRIO_ATTR_MIN_RATE;
104 if (tb[TCA_MQPRIO_MAX_RATE64]) {
107 if (
nla_type(attr) != TCA_MQPRIO_MAX_RATE64)
110 if (i >= mqprio->qm_num_tc)
116 mqprio->qm_mask |= SCH_MQPRIO_ATTR_MAX_RATE;
123static int mqprio_msg_fill(
struct rtnl_tc *tc,
void *data,
struct nl_msg *msg)
125 struct rtnl_mqprio *mqprio = data;
126 struct tc_mqprio_qopt qopt = { 0 };
127 struct nlattr *nest = NULL;
131 !(mqprio->qm_mask & SCH_MQPRIO_ATTR_NUMTC) ||
132 !(mqprio->qm_mask & SCH_MQPRIO_ATTR_PRIOMAP) ||
133 !(mqprio->qm_mask & SCH_MQPRIO_ATTR_QUEUE))
136 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_HW))
139 qopt.hw = mqprio->qm_hw;
141 qopt.num_tc = mqprio->qm_num_tc;
142 memcpy(qopt.count, mqprio->qm_count, TC_QOPT_MAX_QUEUE *
sizeof(uint16_t));
143 memcpy(qopt.offset, mqprio->qm_offset, TC_QOPT_MAX_QUEUE *
sizeof(uint16_t));
144 memcpy(qopt.prio_tc_map, mqprio->qm_prio_map, TC_QOPT_MAX_QUEUE *
sizeof(uint8_t));
149 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_MODE)
150 NLA_PUT_U16(msg, TCA_MQPRIO_MODE, mqprio->qm_mode);
152 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_SHAPER)
153 NLA_PUT_U16(msg, TCA_MQPRIO_SHAPER, mqprio->qm_shaper);
155 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_MIN_RATE) {
158 goto nla_put_failure;
160 for (i = 0; i < mqprio->qm_num_tc; i++) {
161 if (
nla_put(msg, TCA_MQPRIO_MIN_RATE64,
162 sizeof(mqprio->qm_min_rate[i]),
163 &mqprio->qm_min_rate[i]) < 0)
169 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_MAX_RATE) {
172 goto nla_put_failure;
174 for (i = 0; i < mqprio->qm_num_tc; i++) {
175 if (
nla_put(msg, TCA_MQPRIO_MAX_RATE64,
176 sizeof(mqprio->qm_max_rate[i]),
177 &mqprio->qm_max_rate[i]) < 0)
194static void mqprio_dump_line(
struct rtnl_tc *tc,
void *data,
197 struct rtnl_mqprio *mqprio = data;
200 nl_dump(p,
" num_tc %u", mqprio->qm_num_tc);
203static void mqprio_dump_details(
struct rtnl_tc *tc,
void *data,
206 struct rtnl_mqprio *mqprio = data;
214 for (i = 0; i <= TC_QOPT_BITMASK; i++)
215 nl_dump(p,
"%u%s", mqprio->qm_prio_map[i],
216 i < TC_QOPT_BITMASK ?
" " :
"");
233int rtnl_qdisc_mqprio_set_num_tc(
struct rtnl_qdisc *qdisc,
int num_tc)
235 struct rtnl_mqprio *mqprio;
240 mqprio->qm_num_tc = num_tc;
241 mqprio->qm_mask |= SCH_MQPRIO_ATTR_NUMTC;
250int rtnl_qdisc_mqprio_get_num_tc(
struct rtnl_qdisc *qdisc)
252 struct rtnl_mqprio *mqprio;
257 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_NUMTC)
258 return mqprio->qm_num_tc;
260 return -NLE_MISSING_ATTR;
270int rtnl_qdisc_mqprio_set_priomap(
struct rtnl_qdisc *qdisc, uint8_t priomap[],
273 struct rtnl_mqprio *mqprio;
279 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_NUMTC))
280 return -NLE_MISSING_ATTR;
282 if (len > TC_QOPT_BITMASK + 1)
285 for (i = 0; i < len; i++) {
286 if (priomap[i] > mqprio->qm_num_tc)
290 memset(mqprio->qm_prio_map, 0,
sizeof(mqprio->qm_prio_map));
291 memcpy(mqprio->qm_prio_map, priomap, len *
sizeof(uint8_t));
292 mqprio->qm_mask |= SCH_MQPRIO_ATTR_PRIOMAP;
303uint8_t *rtnl_qdisc_mqprio_get_priomap(
struct rtnl_qdisc *qdisc)
305 struct rtnl_mqprio *mqprio;
310 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_PRIOMAP)
311 return mqprio->qm_prio_map;
322int rtnl_qdisc_mqprio_hw_offload(
struct rtnl_qdisc *qdisc,
int offload)
324 struct rtnl_mqprio *mqprio;
332 mqprio->qm_hw = offload;
338 mqprio->qm_mask |= SCH_MQPRIO_ATTR_HW;
347int rtnl_qdisc_mqprio_get_hw_offload(
struct rtnl_qdisc *qdisc)
349 struct rtnl_mqprio *mqprio;
354 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_HW)
355 return mqprio->qm_hw;
367int rtnl_qdisc_mqprio_set_queue(
struct rtnl_qdisc *qdisc, uint16_t count[],
368 uint16_t offset[],
int len)
370 struct rtnl_mqprio *mqprio;
375 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_NUMTC))
376 return -NLE_MISSING_ATTR;
378 if (len < 0 || len > TC_QOPT_MAX_QUEUE)
381 memset(mqprio->qm_count, 0,
sizeof(mqprio->qm_count));
382 memset(mqprio->qm_offset, 0,
sizeof(mqprio->qm_offset));
383 memcpy(mqprio->qm_count, count, len *
sizeof(uint16_t));
384 memcpy(mqprio->qm_offset, offset, len *
sizeof(uint16_t));
385 mqprio->qm_mask |= SCH_MQPRIO_ATTR_QUEUE;
397int rtnl_qdisc_mqprio_get_queue(
struct rtnl_qdisc *qdisc, uint16_t *count,
400 struct rtnl_mqprio *mqprio;
405 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_QUEUE))
406 return -NLE_MISSING_ATTR;
408 memcpy(count, mqprio->qm_count, TC_QOPT_MAX_QUEUE *
sizeof(uint16_t));
409 memcpy(offset, mqprio->qm_offset, TC_QOPT_MAX_QUEUE *
sizeof(uint16_t));
420int rtnl_qdisc_mqprio_set_mode(
struct rtnl_qdisc *qdisc, uint16_t mode)
422 struct rtnl_mqprio *mqprio;
427 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_HW))
428 return -NLE_MISSING_ATTR;
430 mqprio->qm_mode = mode;
431 mqprio->qm_mask |= SCH_MQPRIO_ATTR_MODE;
441int rtnl_qdisc_mqprio_get_mode(
struct rtnl_qdisc *qdisc)
443 struct rtnl_mqprio *mqprio;
448 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_MODE)
449 return mqprio->qm_mode;
451 return -NLE_MISSING_ATTR;
460int rtnl_qdisc_mqprio_set_shaper(
struct rtnl_qdisc *qdisc, uint16_t shaper)
462 struct rtnl_mqprio *mqprio;
467 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_HW))
468 return -NLE_MISSING_ATTR;
470 mqprio->qm_shaper = shaper;
471 mqprio->qm_mask |= SCH_MQPRIO_ATTR_SHAPER;
481int rtnl_qdisc_mqprio_get_shaper(
struct rtnl_qdisc *qdisc)
483 struct rtnl_mqprio *mqprio;
488 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_SHAPER)
489 return mqprio->qm_shaper;
491 return -NLE_MISSING_ATTR;
500int rtnl_qdisc_mqprio_set_min_rate(
struct rtnl_qdisc *qdisc, uint64_t min[],
int len)
502 struct rtnl_mqprio *mqprio;
507 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_SHAPER))
508 return -NLE_MISSING_ATTR;
510 if (mqprio->qm_shaper != TC_MQPRIO_SHAPER_BW_RATE)
513 if (len < 0 || len > TC_QOPT_MAX_QUEUE)
516 memset(mqprio->qm_min_rate, 0,
sizeof(mqprio->qm_min_rate));
517 memcpy(mqprio->qm_min_rate, min, len *
sizeof(uint64_t));
518 mqprio->qm_mask |= SCH_MQPRIO_ATTR_MIN_RATE;
529int rtnl_qdisc_mqprio_get_min_rate(
struct rtnl_qdisc *qdisc, uint64_t *min)
531 struct rtnl_mqprio *mqprio;
536 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_MIN_RATE) {
537 memcpy(min, mqprio->qm_min_rate, TC_QOPT_MAX_QUEUE *
sizeof(uint64_t));
541 return -NLE_MISSING_ATTR;
550int rtnl_qdisc_mqprio_set_max_rate(
struct rtnl_qdisc *qdisc, uint64_t max[],
int len)
552 struct rtnl_mqprio *mqprio;
557 if (!(mqprio->qm_mask & SCH_MQPRIO_ATTR_SHAPER))
558 return -NLE_MISSING_ATTR;
560 if (mqprio->qm_shaper != TC_MQPRIO_SHAPER_BW_RATE)
563 if (len < 0 || len > TC_QOPT_MAX_QUEUE)
566 memset(mqprio->qm_max_rate, 0,
sizeof(mqprio->qm_max_rate));
567 memcpy(mqprio->qm_max_rate, max, len *
sizeof(uint64_t));
568 mqprio->qm_mask |= SCH_MQPRIO_ATTR_MAX_RATE;
579int rtnl_qdisc_mqprio_get_max_rate(
struct rtnl_qdisc *qdisc, uint64_t *max)
581 struct rtnl_mqprio *mqprio;
586 if (mqprio->qm_mask & SCH_MQPRIO_ATTR_MAX_RATE) {
587 memcpy(max, mqprio->qm_max_rate, TC_QOPT_MAX_QUEUE *
sizeof(uint64_t));
591 return -NLE_MISSING_ATTR;
596static struct rtnl_tc_ops mqprio_ops = {
598 .to_type = RTNL_TC_TYPE_QDISC,
599 .to_size =
sizeof(
struct rtnl_mqprio),
600 .to_msg_parser = mqprio_msg_parser,
605 .to_msg_fill = mqprio_msg_fill,
608static void _nl_init mqprio_init(
void)
613static void _nl_exit mqprio_exit(
void)
uint16_t nla_get_u16(const struct nlattr *nla)
Return payload of 16 bit integer attribute.
#define NLA_PUT_U16(msg, attrtype, value)
Add 16 bit integer attribute to netlink message.
int nla_parse(struct nlattr *tb[], int maxtype, struct nlattr *head, int len, const struct nla_policy *policy)
Create attribute index based on a stream of attributes.
uint64_t nla_get_u64(const struct nlattr *nla)
Return payload of u64 attribute.
int nla_type(const struct nlattr *nla)
Return type of the attribute.
struct nlattr * nla_nest_start(struct nl_msg *msg, int attrtype)
Start a new level of nested attributes.
void nla_nest_cancel(struct nl_msg *msg, const struct nlattr *attr)
Cancel the addition of a nested attribute.
#define nla_for_each_nested(pos, nla, rem)
Iterate over a stream of nested attributes.
int nla_nest_end(struct nl_msg *msg, struct nlattr *start)
Finalize nesting of attributes.
int nla_put(struct nl_msg *msg, int attrtype, int datalen, const void *data)
Add a unspecific attribute to netlink message.
@ NLA_NESTED
Nested attributes.
int nlmsg_append(struct nl_msg *n, void *data, size_t len, int pad)
Append data to tail of a netlink message.
void * rtnl_tc_data_peek(struct rtnl_tc *tc)
Returns the private data of the traffic control object.
#define TC_CAST(ptr)
Macro to cast qdisc/class/classifier to tc object.
void * rtnl_tc_data(struct rtnl_tc *)
Return pointer to private data of traffic control object.
int rtnl_tc_register(struct rtnl_tc_ops *)
Register a traffic control module.
void rtnl_tc_unregister(struct rtnl_tc_ops *)
Unregister a traffic control module.
void nl_dump(struct nl_dump_params *params, const char *fmt,...)
Dump a formatted character string.
void nl_new_line(struct nl_dump_params *params)
Handle a new line while dumping.
@ NL_DUMP_LINE
Dump object briefly on one line.
@ NL_DUMP_DETAILS
Dump all attributes but no statistics.
Attribute validation policy.
uint16_t minlen
Minimal length of payload required.
uint16_t type
Type of attribute or NLA_UNSPEC.