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 struct nl_af_group tc_groups[] = {
1060 { AF_UNSPEC, RTNLGRP_TC },
1061 { END_OF_GROUP_LIST },
1065 void rtnl_tc_type_register(
struct rtnl_tc_type_ops *ops)
1067 if (ops->tt_type > RTNL_TC_TYPE_MAX)
1070 tc_type_ops[ops->tt_type] = ops;
1073 void rtnl_tc_type_unregister(
struct rtnl_tc_type_ops *ops)
1075 if (ops->tt_type > RTNL_TC_TYPE_MAX)
1078 tc_type_ops[ops->tt_type] = NULL;
Dump object briefly on one line.
int rtnl_tc_register(struct rtnl_tc_ops *ops)
Register a traffic control module.
uint64_t rtnl_tc_get_stat(struct rtnl_tc *tc, enum rtnl_tc_stat id)
Return value of a statistical counter of a traffic control object.
struct nl_data * nl_data_alloc_attr(struct nlattr *nla)
Allocate abstract data object based on netlink attribute.
void nl_new_line(struct nl_dump_params *params)
Handle a new line while dumping.
int rtnl_tc_calc_txtime(int bufsize, int rate)
Calculate time required to transmit buffer at a specific rate.
void nlmsg_free(struct nl_msg *msg)
Release a reference from an netlink message.
int rtnl_tc_set_kind(struct rtnl_tc *tc, const char *kind)
Define the type of traffic control object.
void * nlmsg_data(const struct nlmsghdr *nlh)
Return pointer to message payload.
uint32_t rtnl_tc_get_linktype(struct rtnl_tc *tc)
Return the linktype of a traffic control object.
uint32_t rtnl_tc_get_overhead(struct rtnl_tc *tc)
Return per packet overhead of a traffic control object.
struct rtnl_link * rtnl_link_get(struct nl_cache *cache, int ifindex)
Lookup link in cache by interface index.
Current bits/s (rate estimator)
int rtnl_tc_calc_cell_log(int cell_size)
Calculate the binary logarithm for a specific cell size.
struct nl_data * nl_data_clone(struct nl_data *src)
Clone an abstract data object.
Attribute validation policy.
struct nl_cache * nl_cache_mngt_require_safe(const char *name)
Return cache previously provided via nl_cache_mngt_provide()
void nl_object_get(struct nl_object *obj)
Acquire a reference on a object.
void rtnl_tc_set_linktype(struct rtnl_tc *tc, uint32_t type)
Set the linktype of a traffic control object.
Current packet/s (rate estimator)
int nlmsg_parse(struct nlmsghdr *nlh, int hdrlen, struct nlattr *tb[], int maxtype, struct nla_policy *policy)
parse attributes of a netlink message
void rtnl_tc_set_parent(struct rtnl_tc *tc, uint32_t parent)
Set the parent identifier of a traffic control object.
NUL terminated character string.
Dump all attributes but no statistics.
void rtnl_tc_set_link(struct rtnl_tc *tc, struct rtnl_link *link)
Set link of traffic control object.
int nla_nest_end(struct nl_msg *msg, struct nlattr *start)
Finalize nesting of attributes.
void rtnl_tc_unregister(struct rtnl_tc_ops *ops)
Unregister a traffic control module.
uint32_t rtnl_tc_get_handle(struct rtnl_tc *tc)
Return identifier of a traffic control object.
nl_dump_type
Enumeration of dumping variations (dp_type)
Total number of overlimits.
int rtnl_tc_calc_bufsize(int txtime, int rate)
Calculate buffer size able to transmit in a specific time and rate.
rtnl_tc_stat
Traffic control statistical identifier.
uint32_t rtnl_tc_get_mtu(struct rtnl_tc *tc)
Return the MTU of traffic control object.
double nl_cancel_down_bytes(unsigned long long l, char **unit)
Cancel down a byte counter.
void rtnl_tc_set_ifindex(struct rtnl_tc *tc, int ifindex)
Set interface index of traffic control object.
#define TC_CAST(ptr)
Macro to cast qdisc/class/classifier to tc object.
int nla_parse_nested(struct nlattr *tb[], int maxtype, struct nlattr *nla, struct nla_policy *policy)
Create attribute index based on nested attribute.
uint32_t rtnl_tc_get_parent(struct rtnl_tc *tc)
Return parent identifier of a traffic control object.
void * nla_data(const struct nlattr *nla)
Return pointer to the payload section.
void rtnl_tc_set_handle(struct rtnl_tc *tc, uint32_t id)
Set identifier of traffic control object.
int nla_parse(struct nlattr *tb[], int maxtype, struct nlattr *head, int len, struct nla_policy *policy)
Create attribute index based on a stream of attributes.
struct nl_data * nl_data_alloc(void *buf, size_t size)
Allocate a new abstract data object.
uint16_t minlen
Minimal length of payload required.
void * rtnl_tc_data(struct rtnl_tc *tc)
Return pointer to private data of traffic control object.
void rtnl_tc_set_mpu(struct rtnl_tc *tc, uint32_t mpu)
Set the Minimum Packet Unit (MPU) of a traffic control object.
int nlmsg_append(struct nl_msg *n, void *data, size_t len, int pad)
Append data to tail of a netlink message.
#define NLA_PUT_STRING(msg, attrtype, value)
Add string attribute to netlink message.
uint16_t type
Type of attribute or NLA_UNSPEC.
struct nl_msg * nlmsg_alloc_simple(int nlmsgtype, int flags)
Allocate a new netlink message.
void rtnl_tc_set_mtu(struct rtnl_tc *tc, uint32_t mtu)
Set the Maximum Transmission Unit (MTU) of traffic control object.
uint32_t nl_us2ticks(uint32_t us)
Convert micro seconds to ticks.
char * rtnl_link_i2name(struct nl_cache *cache, int ifindex, char *dst, size_t len)
Translate interface index to corresponding link name.
char * rtnl_tc_handle2str(uint32_t handle, char *buf, size_t len)
Convert a traffic control handle to a character string (Reentrant).
int rtnl_tc_build_rate_table(struct rtnl_tc *tc, struct rtnl_ratespec *spec, uint32_t *dst)
Compute a transmission time lookup table.
char * rtnl_tc_get_kind(struct rtnl_tc *tc)
Return kind of traffic control object.
Total number of requeues.
void rtnl_tc_set_overhead(struct rtnl_tc *tc, uint32_t overhead)
Set per packet overhead of a traffic control object.
uint32_t rtnl_tc_get_mpu(struct rtnl_tc *tc)
Return the Minimum Packet Unit (MPU) of a traffic control object.
struct rtnl_link * rtnl_tc_get_link(struct rtnl_tc *tc)
Get link of traffic control object.
void nl_dump(struct nl_dump_params *params, const char *fmt,...)
Dump a formatted character string.
void rtnl_link_put(struct rtnl_link *link)
Return a link object reference.
void * nl_data_get(struct nl_data *data)
Get data buffer of abstract data object.
int rtnl_tc_get_ifindex(struct rtnl_tc *tc)
Return interface index of traffic control object.
Total number of packets dropped.
size_t nla_strlcpy(char *dst, const struct nlattr *nla, size_t dstsize)
Copy string attribute payload to a buffer.
struct nlattr * nla_nest_start(struct nl_msg *msg, int attrtype)
Start a new level of nested attributes.
void nl_data_free(struct nl_data *data)
Free an abstract data object.
void * rtnl_tc_data_check(struct rtnl_tc *tc, struct rtnl_tc_ops *ops)
Check traffic control object type and return private data section.