Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * net/sched/gact.c Generic actions |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or |
| 5 | * modify it under the terms of the GNU General Public License |
| 6 | * as published by the Free Software Foundation; either version |
| 7 | * 2 of the License, or (at your option) any later version. |
| 8 | * |
| 9 | * copyright Jamal Hadi Salim (2002-4) |
| 10 | * |
| 11 | */ |
| 12 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 13 | #include <linux/types.h> |
| 14 | #include <linux/kernel.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 15 | #include <linux/string.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 16 | #include <linux/errno.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | #include <linux/skbuff.h> |
| 18 | #include <linux/rtnetlink.h> |
| 19 | #include <linux/module.h> |
| 20 | #include <linux/init.h> |
Arnaldo Carvalho de Melo | dc5fc57 | 2007-03-25 23:06:12 -0700 | [diff] [blame] | 21 | #include <net/netlink.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 | #include <net/pkt_sched.h> |
| 23 | #include <linux/tc_act/tc_gact.h> |
| 24 | #include <net/tc_act/tc_gact.h> |
| 25 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 26 | #define GACT_TAB_MASK 15 |
| 27 | static struct tcf_common *tcf_gact_ht[GACT_TAB_MASK + 1]; |
| 28 | static u32 gact_idx_gen; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | static DEFINE_RWLOCK(gact_lock); |
| 30 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 31 | static struct tcf_hashinfo gact_hash_info = { |
| 32 | .htab = tcf_gact_ht, |
| 33 | .hmask = GACT_TAB_MASK, |
| 34 | .lock = &gact_lock, |
| 35 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 36 | |
| 37 | #ifdef CONFIG_GACT_PROB |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 38 | static int gact_net_rand(struct tcf_gact *gact) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | { |
Kim Nordlund | a163148 | 2006-12-01 20:21:44 -0800 | [diff] [blame] | 40 | if (!gact->tcfg_pval || net_random() % gact->tcfg_pval) |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 41 | return gact->tcf_action; |
| 42 | return gact->tcfg_paction; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 43 | } |
| 44 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 45 | static int gact_determ(struct tcf_gact *gact) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | { |
Kim Nordlund | a163148 | 2006-12-01 20:21:44 -0800 | [diff] [blame] | 47 | if (!gact->tcfg_pval || gact->tcf_bstats.packets % gact->tcfg_pval) |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 48 | return gact->tcf_action; |
| 49 | return gact->tcfg_paction; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 50 | } |
| 51 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 52 | typedef int (*g_rand)(struct tcf_gact *gact); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | static g_rand gact_rand[MAX_RAND]= { NULL, gact_net_rand, gact_determ }; |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 54 | #endif /* CONFIG_GACT_PROB */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | |
Patrick McHardy | 53b2bf3 | 2008-01-23 20:36:30 -0800 | [diff] [blame] | 56 | static const struct nla_policy gact_policy[TCA_GACT_MAX + 1] = { |
| 57 | [TCA_GACT_PARMS] = { .len = sizeof(struct tc_gact) }, |
| 58 | [TCA_GACT_PROB] = { .len = sizeof(struct tc_gact_p) }, |
| 59 | }; |
| 60 | |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 61 | static int tcf_gact_init(struct nlattr *nla, struct nlattr *est, |
YOSHIFUJI Hideaki | 10297b9 | 2007-02-09 23:25:16 +0900 | [diff] [blame] | 62 | struct tc_action *a, int ovr, int bind) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | { |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 64 | struct nlattr *tb[TCA_GACT_MAX + 1]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 65 | struct tc_gact *parm; |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 66 | struct tcf_gact *gact; |
| 67 | struct tcf_common *pc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | int ret = 0; |
Patrick McHardy | cee6372 | 2008-01-23 20:33:32 -0800 | [diff] [blame] | 69 | int err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 70 | |
Patrick McHardy | cee6372 | 2008-01-23 20:33:32 -0800 | [diff] [blame] | 71 | if (nla == NULL) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 72 | return -EINVAL; |
| 73 | |
Patrick McHardy | 53b2bf3 | 2008-01-23 20:36:30 -0800 | [diff] [blame] | 74 | err = nla_parse_nested(tb, TCA_GACT_MAX, nla, gact_policy); |
Patrick McHardy | cee6372 | 2008-01-23 20:33:32 -0800 | [diff] [blame] | 75 | if (err < 0) |
| 76 | return err; |
| 77 | |
Patrick McHardy | 53b2bf3 | 2008-01-23 20:36:30 -0800 | [diff] [blame] | 78 | if (tb[TCA_GACT_PARMS] == NULL) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | return -EINVAL; |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 80 | parm = nla_data(tb[TCA_GACT_PARMS]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | |
Patrick McHardy | 53b2bf3 | 2008-01-23 20:36:30 -0800 | [diff] [blame] | 82 | #ifndef CONFIG_GACT_PROB |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 83 | if (tb[TCA_GACT_PROB] != NULL) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 84 | return -EOPNOTSUPP; |
| 85 | #endif |
| 86 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 87 | pc = tcf_hash_check(parm->index, a, bind, &gact_hash_info); |
| 88 | if (!pc) { |
| 89 | pc = tcf_hash_create(parm->index, est, a, sizeof(*gact), |
| 90 | bind, &gact_idx_gen, &gact_hash_info); |
Stephen Hemminger | 0e991ec | 2008-11-25 21:12:32 -0800 | [diff] [blame^] | 91 | if (IS_ERR(pc)) |
| 92 | return PTR_ERR(pc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | ret = ACT_P_CREATED; |
| 94 | } else { |
| 95 | if (!ovr) { |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 96 | tcf_hash_release(pc, bind, &gact_hash_info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | return -EEXIST; |
| 98 | } |
| 99 | } |
| 100 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 101 | gact = to_gact(pc); |
| 102 | |
| 103 | spin_lock_bh(&gact->tcf_lock); |
| 104 | gact->tcf_action = parm->action; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | #ifdef CONFIG_GACT_PROB |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 106 | if (tb[TCA_GACT_PROB] != NULL) { |
| 107 | struct tc_gact_p *p_parm = nla_data(tb[TCA_GACT_PROB]); |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 108 | gact->tcfg_paction = p_parm->paction; |
| 109 | gact->tcfg_pval = p_parm->pval; |
| 110 | gact->tcfg_ptype = p_parm->ptype; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 | } |
| 112 | #endif |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 113 | spin_unlock_bh(&gact->tcf_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | if (ret == ACT_P_CREATED) |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 115 | tcf_hash_insert(pc, &gact_hash_info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | return ret; |
| 117 | } |
| 118 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 119 | static int tcf_gact_cleanup(struct tc_action *a, int bind) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | { |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 121 | struct tcf_gact *gact = a->priv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 123 | if (gact) |
| 124 | return tcf_hash_release(&gact->common, bind, &gact_hash_info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | return 0; |
| 126 | } |
| 127 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 128 | static int tcf_gact(struct sk_buff *skb, struct tc_action *a, struct tcf_result *res) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | { |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 130 | struct tcf_gact *gact = a->priv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | int action = TC_ACT_SHOT; |
| 132 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 133 | spin_lock(&gact->tcf_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | #ifdef CONFIG_GACT_PROB |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 135 | if (gact->tcfg_ptype && gact_rand[gact->tcfg_ptype] != NULL) |
| 136 | action = gact_rand[gact->tcfg_ptype](gact); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 137 | else |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 138 | action = gact->tcf_action; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | #else |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 140 | action = gact->tcf_action; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 141 | #endif |
Jussi Kivilinna | 0abf77e | 2008-07-20 00:08:27 -0700 | [diff] [blame] | 142 | gact->tcf_bstats.bytes += qdisc_pkt_len(skb); |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 143 | gact->tcf_bstats.packets++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 144 | if (action == TC_ACT_SHOT) |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 145 | gact->tcf_qstats.drops++; |
| 146 | gact->tcf_tm.lastuse = jiffies; |
| 147 | spin_unlock(&gact->tcf_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 148 | |
| 149 | return action; |
| 150 | } |
| 151 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 152 | static int tcf_gact_dump(struct sk_buff *skb, struct tc_action *a, int bind, int ref) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 153 | { |
Arnaldo Carvalho de Melo | 27a884d | 2007-04-19 20:29:13 -0700 | [diff] [blame] | 154 | unsigned char *b = skb_tail_pointer(skb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 | struct tc_gact opt; |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 156 | struct tcf_gact *gact = a->priv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | struct tcf_t t; |
| 158 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 159 | opt.index = gact->tcf_index; |
| 160 | opt.refcnt = gact->tcf_refcnt - ref; |
| 161 | opt.bindcnt = gact->tcf_bindcnt - bind; |
| 162 | opt.action = gact->tcf_action; |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 163 | NLA_PUT(skb, TCA_GACT_PARMS, sizeof(opt), &opt); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 164 | #ifdef CONFIG_GACT_PROB |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 165 | if (gact->tcfg_ptype) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | struct tc_gact_p p_opt; |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 167 | p_opt.paction = gact->tcfg_paction; |
| 168 | p_opt.pval = gact->tcfg_pval; |
| 169 | p_opt.ptype = gact->tcfg_ptype; |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 170 | NLA_PUT(skb, TCA_GACT_PROB, sizeof(p_opt), &p_opt); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 171 | } |
| 172 | #endif |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 173 | t.install = jiffies_to_clock_t(jiffies - gact->tcf_tm.install); |
| 174 | t.lastuse = jiffies_to_clock_t(jiffies - gact->tcf_tm.lastuse); |
| 175 | t.expires = jiffies_to_clock_t(gact->tcf_tm.expires); |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 176 | NLA_PUT(skb, TCA_GACT_TM, sizeof(t), &t); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | return skb->len; |
| 178 | |
Patrick McHardy | 7ba699c | 2008-01-22 22:11:50 -0800 | [diff] [blame] | 179 | nla_put_failure: |
Arnaldo Carvalho de Melo | dc5fc57 | 2007-03-25 23:06:12 -0700 | [diff] [blame] | 180 | nlmsg_trim(skb, b); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 181 | return -1; |
| 182 | } |
| 183 | |
| 184 | static struct tc_action_ops act_gact_ops = { |
| 185 | .kind = "gact", |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 186 | .hinfo = &gact_hash_info, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | .type = TCA_ACT_GACT, |
| 188 | .capab = TCA_CAP_NONE, |
| 189 | .owner = THIS_MODULE, |
| 190 | .act = tcf_gact, |
| 191 | .dump = tcf_gact_dump, |
| 192 | .cleanup = tcf_gact_cleanup, |
| 193 | .lookup = tcf_hash_search, |
| 194 | .init = tcf_gact_init, |
| 195 | .walk = tcf_generic_walker |
| 196 | }; |
| 197 | |
| 198 | MODULE_AUTHOR("Jamal Hadi Salim(2002-4)"); |
| 199 | MODULE_DESCRIPTION("Generic Classifier actions"); |
| 200 | MODULE_LICENSE("GPL"); |
| 201 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 202 | static int __init gact_init_module(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 203 | { |
| 204 | #ifdef CONFIG_GACT_PROB |
| 205 | printk("GACT probability on\n"); |
| 206 | #else |
| 207 | printk("GACT probability NOT on\n"); |
| 208 | #endif |
| 209 | return tcf_register_action(&act_gact_ops); |
| 210 | } |
| 211 | |
David S. Miller | e9ce1cd | 2006-08-21 23:54:55 -0700 | [diff] [blame] | 212 | static void __exit gact_cleanup_module(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 213 | { |
| 214 | tcf_unregister_action(&act_gact_ops); |
| 215 | } |
| 216 | |
| 217 | module_init(gact_init_module); |
| 218 | module_exit(gact_cleanup_module); |