+++ /dev/null
-/*
- * lib/route/sch/netem.c Network Emulator Qdisc
- *
- * This library is free software; you can redistribute it and/or
- * modify it under the terms of the GNU Lesser General Public
- * License as published by the Free Software Foundation version 2.1
- * of the License.
- *
- * Copyright (c) 2003-2006 Thomas Graf <tgraf@suug.ch>
- */
-
-/**
- * @ingroup qdisc
- * @defgroup netem Network Emulator
- * @brief
- *
- * For further documentation see http://linux-net.osdl.org/index.php/Netem
- * @{
- */
-
-#include <netlink-local.h>
-#include <netlink-tc.h>
-#include <netlink/netlink.h>
-#include <netlink/utils.h>
-#include <netlink/route/qdisc.h>
-#include <netlink/route/qdisc-modules.h>
-#include <netlink/route/sch/netem.h>
-
-/** @cond SKIP */
-#define SCH_NETEM_ATTR_LATENCY 0x001
-#define SCH_NETEM_ATTR_LIMIT 0x002
-#define SCH_NETEM_ATTR_LOSS 0x004
-#define SCH_NETEM_ATTR_GAP 0x008
-#define SCH_NETEM_ATTR_DUPLICATE 0x010
-#define SCH_NETEM_ATTR_JITTER 0x020
-#define SCH_NETEM_ATTR_DELAY_CORR 0x040
-#define SCH_NETEM_ATTR_LOSS_CORR 0x080
-#define SCH_NETEM_ATTR_DUP_CORR 0x100
-#define SCH_NETEM_ATTR_RO_PROB 0x200
-#define SCH_NETEM_ATTR_RO_CORR 0x400
-/** @endcond */
-
-static inline struct rtnl_netem *netem_qdisc(struct rtnl_qdisc *qdisc)
-{
- return (struct rtnl_netem *) qdisc->q_subdata;
-}
-
-static inline struct rtnl_netem *netem_alloc(struct rtnl_qdisc *qdisc)
-{
- if (!qdisc->q_subdata)
- qdisc->q_subdata = calloc(1, sizeof(struct rtnl_netem));
-
- return netem_qdisc(qdisc);
-}
-
-static struct nla_policy netem_policy[TCA_NETEM_MAX+1] = {
- [TCA_NETEM_CORR] = { .minlen = sizeof(struct tc_netem_corr) },
- [TCA_NETEM_REORDER] = { .minlen = sizeof(struct tc_netem_reorder) },
-};
-
-static int netem_msg_parser(struct rtnl_qdisc *qdisc)
-{
- int len, err = 0;
- struct rtnl_netem *netem;
- struct tc_netem_qopt *opts;
-
- if (qdisc->q_opts->d_size < sizeof(*opts))
- return nl_error(EINVAL, "Netem specific options size mismatch");
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- opts = (struct tc_netem_qopt *) qdisc->q_opts->d_data;
- netem->qnm_latency = opts->latency;
- netem->qnm_limit = opts->limit;
- netem->qnm_loss = opts->loss;
- netem->qnm_gap = opts->gap;
- netem->qnm_duplicate = opts->duplicate;
- netem->qnm_jitter = opts->jitter;
-
- netem->qnm_mask = (SCH_NETEM_ATTR_LATENCY | SCH_NETEM_ATTR_LIMIT |
- SCH_NETEM_ATTR_LOSS | SCH_NETEM_ATTR_GAP |
- SCH_NETEM_ATTR_DUPLICATE | SCH_NETEM_ATTR_JITTER);
-
- len = qdisc->q_opts->d_size - sizeof(*opts);
-
- if (len > 0) {
- struct nlattr *tb[TCA_NETEM_MAX+1];
-
- err = nla_parse(tb, TCA_NETEM_MAX, (struct nlattr *)
- qdisc->q_opts->d_data + sizeof(*opts),
- len, netem_policy);
- if (err < 0) {
- free(netem);
- return err;
- }
-
- if (tb[TCA_NETEM_CORR]) {
- struct tc_netem_corr cor;
-
- nla_memcpy(&cor, tb[TCA_NETEM_CORR], sizeof(cor));
- netem->qnm_corr.nmc_delay = cor.delay_corr;
- netem->qnm_corr.nmc_loss = cor.loss_corr;
- netem->qnm_corr.nmc_duplicate = cor.dup_corr;
-
- netem->qnm_mask |= (SCH_NETEM_ATTR_DELAY_CORR |
- SCH_NETEM_ATTR_LOSS_CORR |
- SCH_NETEM_ATTR_DELAY_CORR);
- }
-
- if (tb[TCA_NETEM_REORDER]) {
- struct tc_netem_reorder ro;
-
- nla_memcpy(&ro, tb[TCA_NETEM_REORDER], sizeof(ro));
- netem->qnm_ro.nmro_probability = ro.probability;
- netem->qnm_ro.nmro_correlation = ro.correlation;
-
- netem->qnm_mask |= (SCH_NETEM_ATTR_RO_PROB |
- SCH_NETEM_ATTR_RO_CORR);
- }
- }
-
- return 0;
-}
-
-static void netem_free_data(struct rtnl_qdisc *qdisc)
-{
- free(qdisc->q_subdata);
-}
-
-static int netem_dump_brief(struct rtnl_qdisc *qdisc, struct nl_dump_params *p,
- int line)
-{
- struct rtnl_netem *netem = netem_qdisc(qdisc);
-
- if (netem)
- dp_dump(p, "limit %d", netem->qnm_limit);
-
- return line;
-}
-
-static int netem_dump_full(struct rtnl_qdisc *qdisc, struct nl_dump_params *p,
- int line)
-{
- return line;
-}
-
-static struct nl_msg *netem_get_opts(struct rtnl_qdisc *qdisc)
-{
- return NULL;
-}
-
-/**
- * @name Queue Limit
- * @{
- */
-
-/**
- * Set limit of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg limit New limit in bytes.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_limit(struct rtnl_qdisc *qdisc, int limit)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_limit = limit;
- netem->qnm_mask |= SCH_NETEM_ATTR_LIMIT;
-
- return 0;
-}
-
-/**
- * Get limit of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Limit in bytes or a negative error code.
- */
-int rtnl_netem_get_limit(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_LIMIT))
- return netem->qnm_limit;
- else
- return nl_errno(ENOENT);
-}
-
-/** @} */
-
-/**
- * @name Packet Re-ordering
- * @{
- */
-
-/**
- * Set re-ordering gap of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg gap New gap in number of packets.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_gap(struct rtnl_qdisc *qdisc, int gap)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_gap = gap;
- netem->qnm_mask |= SCH_NETEM_ATTR_GAP;
-
- return 0;
-}
-
-/**
- * Get re-ordering gap of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Re-ordering gap in packets or a negative error code.
- */
-int rtnl_netem_get_gap(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_GAP))
- return netem->qnm_gap;
- else
- return nl_errno(ENOENT);
-}
-
-/**
- * Set re-ordering probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New re-ordering probability.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_reorder_probability(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_ro.nmro_probability = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_RO_PROB;
-
- return 0;
-}
-
-/**
- * Get re-ordering probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Re-ordering probability or a negative error code.
- */
-int rtnl_netem_get_reorder_probability(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_RO_PROB))
- return netem->qnm_ro.nmro_probability;
- else
- return nl_errno(ENOENT);
-}
-
-/**
- * Set re-order correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New re-ordering correlation probability.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_reorder_correlation(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_ro.nmro_correlation = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_RO_CORR;
-
- return 0;
-}
-
-/**
- * Get re-ordering correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Re-ordering correlation probability or a negative error code.
- */
-int rtnl_netem_get_reorder_correlation(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_RO_CORR))
- return netem->qnm_ro.nmro_correlation;
- else
- return nl_errno(ENOENT);
-}
-
-/** @} */
-
-/**
- * @name Packet Loss
- * @{
- */
-
-/**
- * Set packet loss probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New packet loss probability.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_loss(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_loss = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_LOSS;
-
- return 0;
-}
-
-/**
- * Get packet loss probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet loss probability or a negative error code.
- */
-int rtnl_netem_get_loss(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_LOSS))
- return netem->qnm_loss;
- else
- return nl_errno(ENOENT);
-}
-
-/**
- * Set packet loss correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New packet loss correlation.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_loss_correlation(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_corr.nmc_loss = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_LOSS_CORR;
-
- return 0;
-}
-
-/**
- * Get packet loss correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet loss correlation probability or a negative error code.
- */
-int rtnl_netem_get_loss_correlation(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_LOSS_CORR))
- return netem->qnm_corr.nmc_loss;
- else
- return nl_errno(ENOENT);
-}
-
-/** @} */
-
-/**
- * @name Packet Duplication
- * @{
- */
-
-/**
- * Set packet duplication probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New packet duplication probability.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_duplicate(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_duplicate = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_DUPLICATE;
-
- return 0;
-}
-
-/**
- * Get packet duplication probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet duplication probability or a negative error code.
- */
-int rtnl_netem_get_duplicate(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_DUPLICATE))
- return netem->qnm_duplicate;
- else
- return nl_errno(ENOENT);
-}
-
-/**
- * Set packet duplication correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New packet duplication correlation probability.
- * @return 0 on sucess or a negative error code.
- */
-int rtnl_netem_set_duplicate_correlation(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_corr.nmc_duplicate = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_DUP_CORR;
-
- return 0;
-}
-
-/**
- * Get packet duplication correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet duplication correlation probability or a negative error code.
- */
-int rtnl_netem_get_duplicate_correlation(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_DUP_CORR))
- return netem->qnm_corr.nmc_duplicate;
- else
- return nl_errno(ENOENT);
-}
-
-/** @} */
-
-/**
- * @name Packet Delay
- * @{
- */
-
-/**
- * Set packet delay of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg delay New packet delay in micro seconds.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_delay(struct rtnl_qdisc *qdisc, int delay)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_latency = nl_us2ticks(delay);
- netem->qnm_mask |= SCH_NETEM_ATTR_LATENCY;
-
- return 0;
-}
-
-/**
- * Get packet delay of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet delay in micro seconds or a negative error code.
- */
-int rtnl_netem_get_delay(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_LATENCY))
- return nl_ticks2us(netem->qnm_latency);
- else
- return nl_errno(ENOENT);
-}
-
-/**
- * Set packet delay jitter of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg jitter New packet delay jitter in micro seconds.
- * @return 0 on success or a negative error code.
- */
-int rtnl_netem_set_jitter(struct rtnl_qdisc *qdisc, int jitter)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_jitter = nl_us2ticks(jitter);
- netem->qnm_mask |= SCH_NETEM_ATTR_JITTER;
-
- return 0;
-}
-
-/**
- * Get packet delay jitter of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet delay jitter in micro seconds or a negative error code.
- */
-int rtnl_netem_get_jitter(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_JITTER))
- return nl_ticks2us(netem->qnm_jitter);
- else
- return nl_errno(ENOENT);
-}
-
-/**
- * Set packet delay correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc to be modified.
- * @arg prob New packet delay correlation probability.
- */
-int rtnl_netem_set_delay_correlation(struct rtnl_qdisc *qdisc, int prob)
-{
- struct rtnl_netem *netem;
-
- netem = netem_alloc(qdisc);
- if (!netem)
- return nl_errno(ENOMEM);
-
- netem->qnm_corr.nmc_delay = prob;
- netem->qnm_mask |= SCH_NETEM_ATTR_DELAY_CORR;
-
- return 0;
-}
-
-/**
- * Get packet delay correlation probability of netem qdisc.
- * @arg qdisc Netem qdisc.
- * @return Packet delay correlation probability or a negative error code.
- */
-int rtnl_netem_get_delay_corellation(struct rtnl_qdisc *qdisc)
-{
- struct rtnl_netem *netem;
-
- netem = netem_qdisc(qdisc);
- if (netem && (netem->qnm_mask & SCH_NETEM_ATTR_DELAY_CORR))
- return netem->qnm_corr.nmc_delay;
- else
- return nl_errno(ENOENT);
-}
-
-/** @} */
-
-static struct rtnl_qdisc_ops netem_ops = {
- .qo_kind = "netem",
- .qo_msg_parser = netem_msg_parser,
- .qo_free_data = netem_free_data,
- .qo_dump[NL_DUMP_BRIEF] = netem_dump_brief,
- .qo_dump[NL_DUMP_FULL] = netem_dump_full,
- .qo_get_opts = netem_get_opts,
-};
-
-static void __init netem_init(void)
-{
- rtnl_qdisc_register(&netem_ops);
-}
-
-static void __exit netem_exit(void)
-{
- rtnl_qdisc_unregister(&netem_ops);
-}
-
-/** @} */