18 #include <netlink-private/netlink.h>
19 #include <netlink-private/tc.h>
20 #include <netlink/netlink.h>
21 #include <netlink/utils.h>
22 #include <netlink/route/rtnl.h>
23 #include <netlink/route/link.h>
24 #include <netlink/route/tc.h>
25 #include <netlink-private/route/tc-api.h>
29 static struct nl_list_head tc_ops_list[__RTNL_TC_TYPE_MAX];
30 static struct rtnl_tc_type_ops *tc_type_ops[__RTNL_TC_TYPE_MAX];
32 static struct nla_policy tc_policy[TCA_MAX+1] = {
34 .maxlen = TCKINDSIZ },
35 [TCA_STATS] = { .minlen =
sizeof(
struct tc_stats) },
39 int tca_parse(
struct nlattr **tb,
int maxattr,
struct rtnl_tc *g,
43 if (g->ce_mask & TCA_ATTR_OPTS)
45 (
struct nlattr *) g->tc_opts->d_data,
46 g->tc_opts->d_size, policy);
50 memset(tb, 0,
sizeof(
struct nlattr *) * (maxattr + 1));
55 static struct nla_policy tc_stats2_policy[TCA_STATS_MAX+1] = {
56 [TCA_STATS_BASIC] = { .
minlen =
sizeof(
struct gnet_stats_basic) },
57 [TCA_STATS_RATE_EST] = { .minlen =
sizeof(
struct gnet_stats_rate_est) },
58 [TCA_STATS_QUEUE] = { .minlen =
sizeof(
struct gnet_stats_queue) },
61 int rtnl_tc_msg_parse(
struct nlmsghdr *n,
struct rtnl_tc *tc)
63 struct nl_cache *link_cache;
64 struct rtnl_tc_ops *ops;
65 struct nlattr *tb[TCA_MAX + 1];
70 tc->ce_msgtype = n->nlmsg_type;
72 err =
nlmsg_parse(n,
sizeof(*tm), tb, TCA_MAX, tc_policy);
76 if (tb[TCA_KIND] == NULL)
77 return -NLE_MISSING_ATTR;
83 tc->tc_family = tm->tcm_family;
84 tc->tc_ifindex = tm->tcm_ifindex;
85 tc->tc_handle = tm->tcm_handle;
86 tc->tc_parent = tm->tcm_parent;
87 tc->tc_info = tm->tcm_info;
89 tc->ce_mask |= (TCA_ATTR_FAMILY | TCA_ATTR_IFINDEX | TCA_ATTR_HANDLE|
90 TCA_ATTR_PARENT | TCA_ATTR_INFO);
92 if (tb[TCA_OPTIONS]) {
96 tc->ce_mask |= TCA_ATTR_OPTS;
100 struct nlattr *tbs[TCA_STATS_MAX + 1];
107 if (tbs[TCA_STATS_BASIC]) {
108 struct gnet_stats_basic *bs;
110 bs =
nla_data(tbs[TCA_STATS_BASIC]);
115 if (tbs[TCA_STATS_RATE_EST]) {
116 struct gnet_stats_rate_est *re;
118 re =
nla_data(tbs[TCA_STATS_RATE_EST]);
123 if (tbs[TCA_STATS_QUEUE]) {
124 struct gnet_stats_queue *q;
134 tc->ce_mask |= TCA_ATTR_STATS;
136 if (tbs[TCA_STATS_APP]) {
138 if (tc->tc_xstats == NULL)
144 struct tc_stats *st =
nla_data(tb[TCA_STATS]);
155 tc->ce_mask |= TCA_ATTR_STATS;
159 if (tb[TCA_XSTATS]) {
161 if (tc->tc_xstats == NULL)
163 tc->ce_mask |= TCA_ATTR_XSTATS;
167 ops = rtnl_tc_get_ops(tc);
168 if (ops && ops->to_msg_parser) {
174 err = ops->to_msg_parser(tc, data);
179 if ((link_cache = __nl_cache_mngt_require(
"route/link"))) {
193 int rtnl_tc_msg_build(
struct rtnl_tc *tc,
int type,
int flags,
194 struct nl_msg **result)
197 struct rtnl_tc_ops *ops;
198 struct tcmsg tchdr = {
199 .tcm_family = AF_UNSPEC,
200 .tcm_ifindex = tc->tc_ifindex,
201 .tcm_handle = tc->tc_handle,
202 .tcm_parent = tc->tc_parent,
204 int err = -NLE_MSGSIZE;
210 if (
nlmsg_append(msg, &tchdr,
sizeof(tchdr), NLMSG_ALIGNTO) < 0)
211 goto nla_put_failure;
213 if (tc->ce_mask & TCA_ATTR_KIND)
216 ops = rtnl_tc_get_ops(tc);
217 if (ops && (ops->to_msg_fill || ops->to_msg_fill_raw)) {
221 if (ops->to_msg_fill) {
223 goto nla_put_failure;
225 if ((err = ops->to_msg_fill(tc, data, msg)) < 0)
226 goto nla_put_failure;
229 }
else if ((err = ops->to_msg_fill_raw(tc, data, msg)) < 0)
230 goto nla_put_failure;
241 void tca_set_kind(
struct rtnl_tc *t,
const char *kind)
243 strncpy(t->tc_kind, kind,
sizeof(t->tc_kind) - 1);
244 t->ce_mask |= TCA_ATTR_KIND;
270 tc->ce_mask &= ~TCA_ATTR_LINK;
272 tc->tc_ifindex = ifindex;
273 tc->ce_mask |= TCA_ATTR_IFINDEX;
282 return tc->tc_ifindex;
308 tc->tc_ifindex = link->l_index;
309 tc->ce_mask |= TCA_ATTR_LINK | TCA_ATTR_IFINDEX;
354 tc->ce_mask |= TCA_ATTR_MTU;
368 if (tc->ce_mask & TCA_ATTR_MTU)
370 else if (tc->ce_mask & TCA_ATTR_LINK)
371 return tc->tc_link->l_mtu;
389 tc->ce_mask |= TCA_ATTR_MPU;
417 tc->tc_overhead = overhead;
418 tc->ce_mask |= TCA_ATTR_OVERHEAD;
429 return tc->tc_overhead;
445 tc->tc_linktype = type;
446 tc->ce_mask |= TCA_ATTR_LINKTYPE;
460 if (tc->ce_mask & TCA_ATTR_LINKTYPE)
461 return tc->tc_linktype;
462 else if (tc->ce_mask & TCA_ATTR_LINK)
463 return tc->tc_link->l_arptype;
476 tc->ce_mask |= TCA_ATTR_HANDLE;
485 return tc->tc_handle;
496 tc->tc_parent = parent;
497 tc->ce_mask |= TCA_ATTR_PARENT;
506 return tc->tc_parent;
518 if (tc->ce_mask & TCA_ATTR_KIND)
521 strncpy(tc->tc_kind, kind,
sizeof(tc->tc_kind) - 1);
522 tc->ce_mask |= TCA_ATTR_KIND;
538 if (tc->ce_mask & TCA_ATTR_KIND)
553 if (id < 0 || id > RTNL_TC_STATS_MAX)
556 return tc->tc_stats[id];
584 tx_time_secs = (double) bufsize / (
double) rate;
586 return tx_time_secs * 1000000.;
607 bufsize = (double) txtime * (
double) rate;
609 return bufsize / 1000000.;
621 for (i = 0; i < 32; i++)
622 if ((1 << i) == cell_size)
651 static unsigned int align_to_atm(
unsigned int size)
654 cells = size / ATM_CELL_PAYLOAD;
655 if ((size % ATM_CELL_PAYLOAD) > 0)
658 linksize = cells * ATM_CELL_SIZE;
662 static unsigned int adjust_size(
unsigned int size,
unsigned int mpu,
670 return align_to_atm(size);
696 uint8_t cell_log = spec->rs_cell_log;
697 unsigned int size, i;
705 if (cell_log == UINT8_MAX) {
712 while ((mtu >> cell_log) >= RTNL_TC_RTABLE_SIZE)
716 for (i = 0; i < RTNL_TC_RTABLE_SIZE; i++) {
717 size = adjust_size((i + 1) << cell_log, spec->rs_mpu, linktype);
721 spec->rs_cell_align = -1;
722 spec->rs_cell_log = cell_log;
733 void rtnl_tc_free_data(
struct nl_object *obj)
735 struct rtnl_tc *tc =
TC_CAST(obj);
736 struct rtnl_tc_ops *ops;
742 if (tc->tc_subdata) {
743 ops = rtnl_tc_get_ops(tc);
744 if (ops && ops->to_free_data)
745 ops->to_free_data(tc,
nl_data_get(tc->tc_subdata));
751 int rtnl_tc_clone(
struct nl_object *dstobj,
struct nl_object *srcobj)
753 struct rtnl_tc *dst =
TC_CAST(dstobj);
754 struct rtnl_tc *src =
TC_CAST(srcobj);
755 struct rtnl_tc_ops *ops;
759 dst->tc_link = src->tc_link;
768 if (src->tc_xstats) {
774 if (src->tc_subdata) {
780 ops = rtnl_tc_get_ops(src);
781 if (ops && ops->to_clone) {
789 return ops->to_clone(a, b);
795 static int tc_dump(
struct rtnl_tc *tc,
enum nl_dump_type type,
798 struct rtnl_tc_type_ops *type_ops;
799 struct rtnl_tc_ops *ops;
802 type_ops = tc_type_ops[tc->tc_type];
803 if (type_ops && type_ops->tt_dump[type])
804 type_ops->tt_dump[type](tc, p);
806 ops = rtnl_tc_get_ops(tc);
807 if (ops && ops->to_dump[type]) {
808 ops->to_dump[type](tc, data, p);
815 void rtnl_tc_dump_line(
struct nl_object *obj,
struct nl_dump_params *p)
817 struct rtnl_tc_type_ops *type_ops;
818 struct rtnl_tc *tc =
TC_CAST(obj);
819 struct nl_cache *link_cache;
824 type_ops = tc_type_ops[tc->tc_type];
825 if (type_ops && type_ops->tt_dump_prefix)
826 nl_dump(p,
"%s ", type_ops->tt_dump_prefix);
828 nl_dump(p,
"%s ", tc->tc_kind);
835 nl_dump(p,
"dev %u ", tc->tc_ifindex);
847 nl_cache_put(link_cache);
850 void rtnl_tc_dump_details(
struct nl_object *obj,
struct nl_dump_params *p)
852 struct rtnl_tc *tc =
TC_CAST(obj);
854 rtnl_tc_dump_line(OBJ_CAST(tc), p);
856 nl_dump_line(p,
" ");
858 if (tc->ce_mask & TCA_ATTR_MTU)
859 nl_dump(p,
" mtu %u", tc->tc_mtu);
861 if (tc->ce_mask & TCA_ATTR_MPU)
862 nl_dump(p,
" mpu %u", tc->tc_mpu);
864 if (tc->ce_mask & TCA_ATTR_OVERHEAD)
865 nl_dump(p,
" overhead %u", tc->tc_overhead);
872 void rtnl_tc_dump_stats(
struct nl_object *obj,
struct nl_dump_params *p)
874 struct rtnl_tc *tc =
TC_CAST(obj);
878 rtnl_tc_dump_details(OBJ_CAST(tc), p);
880 strcpy(fmt,
" %7.2f %s %10u %10u %10u %10u %10u\n");
883 " Stats: bytes packets drops overlimits" \
890 nl_dump_line(p, fmt, res, unit,
899 strcpy(fmt,
" %7.2f %s/s%9u pps");
910 int rtnl_tc_compare(
struct nl_object *aobj,
struct nl_object *bobj,
911 uint32_t attrs,
int flags)
913 struct rtnl_tc *a =
TC_CAST(aobj);
914 struct rtnl_tc *b =
TC_CAST(bobj);
917 #define TC_DIFF(ATTR, EXPR) ATTR_DIFF(attrs, TCA_ATTR_##ATTR, a, b, EXPR)
919 diff |= TC_DIFF(HANDLE, a->tc_handle != b->tc_handle);
920 diff |= TC_DIFF(PARENT, a->tc_parent != b->tc_parent);
921 diff |= TC_DIFF(IFINDEX, a->tc_ifindex != b->tc_ifindex);
922 diff |= TC_DIFF(KIND, strcmp(a->tc_kind, b->tc_kind));
935 struct rtnl_tc_ops *rtnl_tc_lookup_ops(
enum rtnl_tc_type type,
const char *kind)
937 struct rtnl_tc_ops *ops;
939 nl_list_for_each_entry(ops, &tc_ops_list[type], to_list)
940 if (!strcmp(kind, ops->to_kind))
946 struct rtnl_tc_ops *rtnl_tc_get_ops(struct rtnl_tc *tc)
949 tc->tc_ops = rtnl_tc_lookup_ops(tc->tc_type, tc->tc_kind);
971 for (i = 0; i < __RTNL_TC_TYPE_MAX; i++)
972 nl_init_list_head(&tc_ops_list[i]);
977 if (!ops->to_kind || ops->to_type > RTNL_TC_TYPE_MAX)
980 if (rtnl_tc_lookup_ops(ops->to_type, ops->to_kind))
983 nl_list_add_tail(&ops->to_list, &tc_ops_list[ops->to_type]);
994 nl_list_del(&ops->to_list);
1008 if (!tc->tc_subdata) {
1015 if (!rtnl_tc_get_ops(tc))
1019 if (!(size = tc->tc_ops->to_size))
1045 if (tc->tc_ops != ops) {
1048 snprintf(buf,
sizeof(buf),
1049 "tc object %p used in %s context but is of type %s",
1050 tc, ops->to_kind, tc->tc_ops->to_kind);
1059 void rtnl_tc_type_register(
struct rtnl_tc_type_ops *ops)
1061 if (ops->tt_type > RTNL_TC_TYPE_MAX)
1064 tc_type_ops[ops->tt_type] = ops;
1067 void rtnl_tc_type_unregister(
struct rtnl_tc_type_ops *ops)
1069 if (ops->tt_type > RTNL_TC_TYPE_MAX)
1072 tc_type_ops[ops->tt_type] = NULL;