pkt_sched: skbedit add support for setting mark
[linux-2.6.git] / net / sched / act_skbedit.c
index 4ab916b8074be28daea9fe9f329b4b3b460132c7..e9607fe55b58006af76880c8e5364a16c3cebdbd 100644 (file)
@@ -54,6 +54,8 @@ static int tcf_skbedit(struct sk_buff *skb, struct tc_action *a,
        if (d->flags & SKBEDIT_F_QUEUE_MAPPING &&
            skb->dev->real_num_tx_queues > d->queue_mapping)
                skb_set_queue_mapping(skb, d->queue_mapping);
+       if (d->flags & SKBEDIT_F_MARK)
+               skb->mark = d->mark;
 
        spin_unlock(&d->tcf_lock);
        return d->tcf_action;
@@ -63,6 +65,7 @@ static const struct nla_policy skbedit_policy[TCA_SKBEDIT_MAX + 1] = {
        [TCA_SKBEDIT_PARMS]             = { .len = sizeof(struct tc_skbedit) },
        [TCA_SKBEDIT_PRIORITY]          = { .len = sizeof(u32) },
        [TCA_SKBEDIT_QUEUE_MAPPING]     = { .len = sizeof(u16) },
+       [TCA_SKBEDIT_MARK]              = { .len = sizeof(u32) },
 };
 
 static int tcf_skbedit_init(struct nlattr *nla, struct nlattr *est,
@@ -72,7 +75,7 @@ static int tcf_skbedit_init(struct nlattr *nla, struct nlattr *est,
        struct tc_skbedit *parm;
        struct tcf_skbedit *d;
        struct tcf_common *pc;
-       u32 flags = 0, *priority = NULL;
+       u32 flags = 0, *priority = NULL, *mark = NULL;
        u16 *queue_mapping = NULL;
        int ret = 0, err;
 
@@ -95,6 +98,12 @@ static int tcf_skbedit_init(struct nlattr *nla, struct nlattr *est,
                flags |= SKBEDIT_F_QUEUE_MAPPING;
                queue_mapping = nla_data(tb[TCA_SKBEDIT_QUEUE_MAPPING]);
        }
+
+       if (tb[TCA_SKBEDIT_MARK] != NULL) {
+               flags |= SKBEDIT_F_MARK;
+               mark = nla_data(tb[TCA_SKBEDIT_MARK]);
+       }
+
        if (!flags)
                return -EINVAL;
 
@@ -124,6 +133,9 @@ static int tcf_skbedit_init(struct nlattr *nla, struct nlattr *est,
                d->priority = *priority;
        if (flags & SKBEDIT_F_QUEUE_MAPPING)
                d->queue_mapping = *queue_mapping;
+       if (flags & SKBEDIT_F_MARK)
+               d->mark = *mark;
+
        d->tcf_action = parm->action;
 
        spin_unlock_bh(&d->tcf_lock);
@@ -161,6 +173,9 @@ static inline int tcf_skbedit_dump(struct sk_buff *skb, struct tc_action *a,
        if (d->flags & SKBEDIT_F_QUEUE_MAPPING)
                NLA_PUT(skb, TCA_SKBEDIT_QUEUE_MAPPING,
                        sizeof(d->queue_mapping), &d->queue_mapping);
+       if (d->flags & SKBEDIT_F_MARK)
+               NLA_PUT(skb, TCA_SKBEDIT_MARK, sizeof(d->mark),
+                       &d->mark);
        t.install = jiffies_to_clock_t(jiffies - d->tcf_tm.install);
        t.lastuse = jiffies_to_clock_t(jiffies - d->tcf_tm.lastuse);
        t.expires = jiffies_to_clock_t(d->tcf_tm.expires);