00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012 #include <netlink-local.h>
00013 #include <netlink-tc.h>
00014 #include <netlink/netlink.h>
00015 #include <netlink/utils.h>
00016 #include <netlink/route/qdisc.h>
00017 #include <netlink/route/qdisc-modules.h>
00018 #include <netlink/route/class.h>
00019 #include <netlink/route/class-modules.h>
00020 #include <netlink/route/link.h>
00021 #include <netlink/route/sch/cbq.h>
00022 #include <netlink/route/cls/police.h>
00023
00024
00025
00026
00027
00028
00029
00030
00031 static struct trans_tbl ovl_strategies[] = {
00032 __ADD(TC_CBQ_OVL_CLASSIC,classic)
00033 __ADD(TC_CBQ_OVL_DELAY,delay)
00034 __ADD(TC_CBQ_OVL_LOWPRIO,lowprio)
00035 __ADD(TC_CBQ_OVL_DROP,drop)
00036 __ADD(TC_CBQ_OVL_RCLASSIC,rclassic)
00037 };
00038
00039
00040
00041
00042
00043
00044
00045
00046
00047
00048
00049 char *nl_ovl_strategy2str(int type, char *buf, size_t len)
00050 {
00051 return __type2str(type, buf, len, ovl_strategies,
00052 ARRAY_SIZE(ovl_strategies));
00053 }
00054
00055
00056
00057
00058
00059
00060
00061
00062 int nl_str2ovl_strategy(const char *name)
00063 {
00064 return __str2type(name, ovl_strategies, ARRAY_SIZE(ovl_strategies));
00065 }
00066
00067 static struct nla_policy cbq_policy[TCA_CBQ_MAX+1] = {
00068 [TCA_CBQ_LSSOPT] = { .minlen = sizeof(struct tc_cbq_lssopt) },
00069 [TCA_CBQ_RATE] = { .minlen = sizeof(struct tc_ratespec) },
00070 [TCA_CBQ_WRROPT] = { .minlen = sizeof(struct tc_cbq_wrropt) },
00071 [TCA_CBQ_OVL_STRATEGY] = { .minlen = sizeof(struct tc_cbq_ovl) },
00072 [TCA_CBQ_FOPT] = { .minlen = sizeof(struct tc_cbq_fopt) },
00073 [TCA_CBQ_POLICE] = { .minlen = sizeof(struct tc_cbq_police) },
00074 };
00075
00076 static inline struct rtnl_cbq *cbq_qdisc(struct rtnl_tca *tca)
00077 {
00078 return (struct rtnl_cbq *) tca->tc_subdata;
00079 }
00080
00081 static inline struct rtnl_cbq *cbq_alloc(struct rtnl_tca *tca)
00082 {
00083 if (!tca->tc_subdata)
00084 tca->tc_subdata = calloc(1, sizeof(struct rtnl_qdisc));
00085
00086 return cbq_qdisc(tca);
00087 }
00088
00089
00090 static int cbq_msg_parser(struct rtnl_tca *tca)
00091 {
00092 struct nlattr *tb[TCA_CBQ_MAX + 1];
00093 struct rtnl_cbq *cbq;
00094 int err;
00095
00096 err = tca_parse(tb, TCA_CBQ_MAX, tca, cbq_policy);
00097 if (err < 0)
00098 return err;
00099
00100 cbq = cbq_alloc(tca);
00101 if (!cbq)
00102 return nl_errno(ENOMEM);
00103
00104 nla_memcpy(&cbq->cbq_lss, tb[TCA_CBQ_LSSOPT], sizeof(cbq->cbq_lss));
00105 nla_memcpy(&cbq->cbq_rate, tb[TCA_CBQ_RATE], sizeof(cbq->cbq_rate));
00106 nla_memcpy(&cbq->cbq_wrr, tb[TCA_CBQ_WRROPT], sizeof(cbq->cbq_wrr));
00107 nla_memcpy(&cbq->cbq_fopt, tb[TCA_CBQ_FOPT], sizeof(cbq->cbq_fopt));
00108 nla_memcpy(&cbq->cbq_ovl, tb[TCA_CBQ_OVL_STRATEGY],
00109 sizeof(cbq->cbq_ovl));
00110 nla_memcpy(&cbq->cbq_police, tb[TCA_CBQ_POLICE],
00111 sizeof(cbq->cbq_police));
00112
00113 return 0;
00114 }
00115
00116 static int cbq_qdisc_msg_parser(struct rtnl_qdisc *qdisc)
00117 {
00118 return cbq_msg_parser((struct rtnl_tca *) qdisc);
00119 }
00120
00121 static int cbq_class_msg_parser(struct rtnl_class *class)
00122 {
00123 return cbq_msg_parser((struct rtnl_tca *) class);
00124 }
00125
00126 static void cbq_qdisc_free_data(struct rtnl_qdisc *qdisc)
00127 {
00128 free(qdisc->q_subdata);
00129 }
00130
00131 static void cbq_class_free_data(struct rtnl_class *class)
00132 {
00133 free(class->c_subdata);
00134 }
00135
00136 static int cbq_dump_brief(struct rtnl_tca *tca, struct nl_dump_params *p,
00137 int line)
00138 {
00139 struct rtnl_cbq *cbq;
00140 double r, rbit;
00141 char *ru, *rubit;
00142
00143 cbq = cbq_qdisc(tca);
00144 if (!cbq)
00145 goto ignore;
00146
00147 r = nl_cancel_down_bytes(cbq->cbq_rate.rate, &ru);
00148 rbit = nl_cancel_down_bits(cbq->cbq_rate.rate * 8, &rubit);
00149
00150 dp_dump(p, " rate %.2f%s/s (%.0f%s) prio %u",
00151 r, ru, rbit, rubit, cbq->cbq_wrr.priority);
00152
00153 ignore:
00154 return line;
00155 }
00156
00157 static int cbq_qdisc_dump_brief(struct rtnl_qdisc *qdisc,
00158 struct nl_dump_params *p, int line)
00159 {
00160 return cbq_dump_brief((struct rtnl_tca *) qdisc, p, line);
00161 }
00162
00163 static int cbq_class_dump_brief(struct rtnl_class *class,
00164 struct nl_dump_params *p, int line)
00165 {
00166 return cbq_dump_brief((struct rtnl_tca *) class, p, line);
00167 }
00168
00169 static int cbq_dump_full(struct rtnl_tca *tca, struct nl_dump_params *p,
00170 int line)
00171 {
00172 struct rtnl_cbq *cbq;
00173 char *unit, buf[32];
00174 double w;
00175 uint32_t el;
00176
00177 cbq = cbq_qdisc(tca);
00178 if (!cbq)
00179 goto ignore;
00180
00181 w = nl_cancel_down_bits(cbq->cbq_wrr.weight * 8, &unit);
00182
00183 dp_dump(p, "avgpkt %u mpu %u cell %u allot %u weight %.0f%s\n",
00184 cbq->cbq_lss.avpkt,
00185 cbq->cbq_rate.mpu,
00186 1 << cbq->cbq_rate.cell_log,
00187 cbq->cbq_wrr.allot, w, unit);
00188
00189 el = cbq->cbq_lss.ewma_log;
00190 dp_dump_line(p, line++, " minidle %uus maxidle %uus offtime "
00191 "%uus level %u ewma_log %u\n",
00192 nl_ticks2us(cbq->cbq_lss.minidle >> el),
00193 nl_ticks2us(cbq->cbq_lss.maxidle >> el),
00194 nl_ticks2us(cbq->cbq_lss.offtime >> el),
00195 cbq->cbq_lss.level,
00196 cbq->cbq_lss.ewma_log);
00197
00198 dp_dump_line(p, line++, " penalty %uus strategy %s ",
00199 nl_ticks2us(cbq->cbq_ovl.penalty),
00200 nl_ovl_strategy2str(cbq->cbq_ovl.strategy, buf, sizeof(buf)));
00201
00202 dp_dump(p, "split %s defmap 0x%08x ",
00203 rtnl_tc_handle2str(cbq->cbq_fopt.split, buf, sizeof(buf)),
00204 cbq->cbq_fopt.defmap);
00205
00206 dp_dump(p, "police %s",
00207 nl_police2str(cbq->cbq_police.police, buf, sizeof(buf)));
00208
00209 ignore:
00210 return line;
00211 }
00212
00213 static int cbq_qdisc_dump_full(struct rtnl_qdisc *qdisc,
00214 struct nl_dump_params *p, int line)
00215 {
00216 return cbq_dump_full((struct rtnl_tca *) qdisc, p, line);
00217 }
00218
00219 static int cbq_class_dump_full(struct rtnl_class *class,
00220 struct nl_dump_params *p, int line)
00221 {
00222 return cbq_dump_full((struct rtnl_tca *) class, p, line);
00223 }
00224
00225 static int cbq_dump_with_stats(struct rtnl_tca *tca, struct nl_dump_params *p,
00226 int line)
00227 {
00228 struct tc_cbq_xstats *x = tca_xstats(tca);
00229
00230 if (!x)
00231 goto ignore;
00232
00233 dp_dump_line(p, line++, " borrows overact "
00234 " avgidle undertime\n");
00235 dp_dump_line(p, line++, " %10u %10u %10u %10u\n",
00236 x->borrows, x->overactions, x->avgidle, x->undertime);
00237
00238 ignore:
00239 return line;
00240 }
00241
00242 static int cbq_qdisc_dump_with_stats(struct rtnl_qdisc *qdisc,
00243 struct nl_dump_params *p, int line)
00244 {
00245 return cbq_dump_with_stats((struct rtnl_tca *) qdisc, p, line);
00246 }
00247
00248 static int cbq_class_dump_with_stats(struct rtnl_class *class,
00249 struct nl_dump_params *p, int line)
00250 {
00251 return cbq_dump_with_stats((struct rtnl_tca *) class, p, line);
00252 }
00253
00254 static struct rtnl_qdisc_ops cbq_qdisc_ops = {
00255 .qo_kind = "cbq",
00256 .qo_msg_parser = cbq_qdisc_msg_parser,
00257 .qo_free_data = cbq_qdisc_free_data,
00258 .qo_dump[NL_DUMP_BRIEF] = cbq_qdisc_dump_brief,
00259 .qo_dump[NL_DUMP_FULL] = cbq_qdisc_dump_full,
00260 .qo_dump[NL_DUMP_STATS] = cbq_qdisc_dump_with_stats,
00261 };
00262
00263 static struct rtnl_class_ops cbq_class_ops = {
00264 .co_kind = "cbq",
00265 .co_msg_parser = cbq_class_msg_parser,
00266 .co_free_data = cbq_class_free_data,
00267 .co_dump[NL_DUMP_BRIEF] = cbq_class_dump_brief,
00268 .co_dump[NL_DUMP_FULL] = cbq_class_dump_full,
00269 .co_dump[NL_DUMP_STATS] = cbq_class_dump_with_stats,
00270 };
00271
00272 static void __init cbq_init(void)
00273 {
00274 rtnl_qdisc_register(&cbq_qdisc_ops);
00275 rtnl_class_register(&cbq_class_ops);
00276 }
00277
00278 static void __exit cbq_exit(void)
00279 {
00280 rtnl_qdisc_unregister(&cbq_qdisc_ops);
00281 rtnl_class_unregister(&cbq_class_ops);
00282 }
00283
00284