]>
Commit | Line | Data |
---|---|---|
2874c5fd | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
c7e2b968 JP |
2 | /* |
3 | * Copyright (c) 2014 Jiri Pirko <jiri@resnulli.us> | |
c7e2b968 JP |
4 | */ |
5 | ||
6 | #include <linux/module.h> | |
7 | #include <linux/init.h> | |
8 | #include <linux/kernel.h> | |
9 | #include <linux/skbuff.h> | |
10 | #include <linux/rtnetlink.h> | |
11 | #include <linux/if_vlan.h> | |
12 | #include <net/netlink.h> | |
13 | #include <net/pkt_sched.h> | |
7e0c8892 | 14 | #include <net/pkt_cls.h> |
c7e2b968 JP |
15 | |
16 | #include <linux/tc_act/tc_vlan.h> | |
17 | #include <net/tc_act/tc_vlan.h> | |
18 | ||
c7d03a00 | 19 | static unsigned int vlan_net_id; |
a85a970a | 20 | static struct tc_action_ops act_vlan_ops; |
ddf97ccd | 21 | |
8aa7f22e JHS |
22 | static int tcf_vlan_act(struct sk_buff *skb, const struct tc_action *a, |
23 | struct tcf_result *res) | |
c7e2b968 | 24 | { |
a85a970a | 25 | struct tcf_vlan *v = to_vlan(a); |
4c5b9d96 | 26 | struct tcf_vlan_params *p; |
c7e2b968 JP |
27 | int action; |
28 | int err; | |
45a497f2 | 29 | u16 tci; |
c7e2b968 | 30 | |
9c4a4e48 | 31 | tcf_lastuse_update(&v->tcf_tm); |
e0496cbb MK |
32 | bstats_cpu_update(this_cpu_ptr(v->common.cpu_bstats), skb); |
33 | ||
f39acc84 SL |
34 | /* Ensure 'data' points at mac_header prior calling vlan manipulating |
35 | * functions. | |
36 | */ | |
37 | if (skb_at_tc_ingress(skb)) | |
38 | skb_push_rcsum(skb, skb->mac_len); | |
39 | ||
4c5b9d96 MK |
40 | action = READ_ONCE(v->tcf_action); |
41 | ||
7fd4b288 | 42 | p = rcu_dereference_bh(v->vlan_p); |
4c5b9d96 MK |
43 | |
44 | switch (p->tcfv_action) { | |
c7e2b968 JP |
45 | case TCA_VLAN_ACT_POP: |
46 | err = skb_vlan_pop(skb); | |
47 | if (err) | |
48 | goto drop; | |
49 | break; | |
50 | case TCA_VLAN_ACT_PUSH: | |
4c5b9d96 MK |
51 | err = skb_vlan_push(skb, p->tcfv_push_proto, p->tcfv_push_vid | |
52 | (p->tcfv_push_prio << VLAN_PRIO_SHIFT)); | |
c7e2b968 JP |
53 | if (err) |
54 | goto drop; | |
55 | break; | |
45a497f2 SL |
56 | case TCA_VLAN_ACT_MODIFY: |
57 | /* No-op if no vlan tag (either hw-accel or in-payload) */ | |
58 | if (!skb_vlan_tagged(skb)) | |
7fd4b288 | 59 | goto out; |
45a497f2 SL |
60 | /* extract existing tag (and guarantee no hw-accel tag) */ |
61 | if (skb_vlan_tag_present(skb)) { | |
62 | tci = skb_vlan_tag_get(skb); | |
b1817524 | 63 | __vlan_hwaccel_clear_tag(skb); |
45a497f2 SL |
64 | } else { |
65 | /* in-payload vlan tag, pop it */ | |
66 | err = __skb_vlan_pop(skb, &tci); | |
67 | if (err) | |
68 | goto drop; | |
69 | } | |
70 | /* replace the vid */ | |
4c5b9d96 | 71 | tci = (tci & ~VLAN_VID_MASK) | p->tcfv_push_vid; |
45a497f2 | 72 | /* replace prio bits, if tcfv_push_prio specified */ |
4c5b9d96 | 73 | if (p->tcfv_push_prio) { |
45a497f2 | 74 | tci &= ~VLAN_PRIO_MASK; |
4c5b9d96 | 75 | tci |= p->tcfv_push_prio << VLAN_PRIO_SHIFT; |
45a497f2 SL |
76 | } |
77 | /* put updated tci as hwaccel tag */ | |
4c5b9d96 | 78 | __vlan_hwaccel_put_tag(skb, p->tcfv_push_proto, tci); |
45a497f2 | 79 | break; |
c7e2b968 JP |
80 | default: |
81 | BUG(); | |
82 | } | |
83 | ||
7fd4b288 | 84 | out: |
f39acc84 SL |
85 | if (skb_at_tc_ingress(skb)) |
86 | skb_pull_rcsum(skb, skb->mac_len); | |
87 | ||
c7e2b968 | 88 | return action; |
7fd4b288 PA |
89 | |
90 | drop: | |
91 | qstats_drop_inc(this_cpu_ptr(v->common.cpu_qstats)); | |
92 | return TC_ACT_SHOT; | |
c7e2b968 JP |
93 | } |
94 | ||
95 | static const struct nla_policy vlan_policy[TCA_VLAN_MAX + 1] = { | |
96 | [TCA_VLAN_PARMS] = { .len = sizeof(struct tc_vlan) }, | |
97 | [TCA_VLAN_PUSH_VLAN_ID] = { .type = NLA_U16 }, | |
98 | [TCA_VLAN_PUSH_VLAN_PROTOCOL] = { .type = NLA_U16 }, | |
956af371 | 99 | [TCA_VLAN_PUSH_VLAN_PRIORITY] = { .type = NLA_U8 }, |
c7e2b968 JP |
100 | }; |
101 | ||
102 | static int tcf_vlan_init(struct net *net, struct nlattr *nla, | |
a85a970a | 103 | struct nlattr *est, struct tc_action **a, |
789871bb | 104 | int ovr, int bind, bool rtnl_held, |
85d0966f | 105 | struct tcf_proto *tp, struct netlink_ext_ack *extack) |
c7e2b968 | 106 | { |
ddf97ccd | 107 | struct tc_action_net *tn = net_generic(net, vlan_net_id); |
c7e2b968 | 108 | struct nlattr *tb[TCA_VLAN_MAX + 1]; |
7e0c8892 | 109 | struct tcf_chain *goto_ch = NULL; |
764e9a24 | 110 | struct tcf_vlan_params *p; |
c7e2b968 JP |
111 | struct tc_vlan *parm; |
112 | struct tcf_vlan *v; | |
113 | int action; | |
94cb5492 | 114 | u16 push_vid = 0; |
c7e2b968 | 115 | __be16 push_proto = 0; |
956af371 | 116 | u8 push_prio = 0; |
b2313077 WC |
117 | bool exists = false; |
118 | int ret = 0, err; | |
7be8ef2c | 119 | u32 index; |
c7e2b968 JP |
120 | |
121 | if (!nla) | |
122 | return -EINVAL; | |
123 | ||
8cb08174 JB |
124 | err = nla_parse_nested_deprecated(tb, TCA_VLAN_MAX, nla, vlan_policy, |
125 | NULL); | |
c7e2b968 JP |
126 | if (err < 0) |
127 | return err; | |
128 | ||
129 | if (!tb[TCA_VLAN_PARMS]) | |
130 | return -EINVAL; | |
131 | parm = nla_data(tb[TCA_VLAN_PARMS]); | |
7be8ef2c DL |
132 | index = parm->index; |
133 | err = tcf_idr_check_alloc(tn, &index, a, bind); | |
0190c1d4 VB |
134 | if (err < 0) |
135 | return err; | |
136 | exists = err; | |
5026c9b1 JHS |
137 | if (exists && bind) |
138 | return 0; | |
139 | ||
c7e2b968 JP |
140 | switch (parm->v_action) { |
141 | case TCA_VLAN_ACT_POP: | |
142 | break; | |
143 | case TCA_VLAN_ACT_PUSH: | |
45a497f2 | 144 | case TCA_VLAN_ACT_MODIFY: |
5026c9b1 JHS |
145 | if (!tb[TCA_VLAN_PUSH_VLAN_ID]) { |
146 | if (exists) | |
65a206c0 | 147 | tcf_idr_release(*a, bind); |
0190c1d4 | 148 | else |
7be8ef2c | 149 | tcf_idr_cleanup(tn, index); |
c7e2b968 | 150 | return -EINVAL; |
5026c9b1 | 151 | } |
c7e2b968 | 152 | push_vid = nla_get_u16(tb[TCA_VLAN_PUSH_VLAN_ID]); |
5026c9b1 JHS |
153 | if (push_vid >= VLAN_VID_MASK) { |
154 | if (exists) | |
65a206c0 | 155 | tcf_idr_release(*a, bind); |
0190c1d4 | 156 | else |
7be8ef2c | 157 | tcf_idr_cleanup(tn, index); |
c7e2b968 | 158 | return -ERANGE; |
5026c9b1 | 159 | } |
c7e2b968 JP |
160 | |
161 | if (tb[TCA_VLAN_PUSH_VLAN_PROTOCOL]) { | |
162 | push_proto = nla_get_be16(tb[TCA_VLAN_PUSH_VLAN_PROTOCOL]); | |
163 | switch (push_proto) { | |
164 | case htons(ETH_P_8021Q): | |
165 | case htons(ETH_P_8021AD): | |
166 | break; | |
167 | default: | |
5a4931ae DC |
168 | if (exists) |
169 | tcf_idr_release(*a, bind); | |
0190c1d4 | 170 | else |
7be8ef2c | 171 | tcf_idr_cleanup(tn, index); |
c7e2b968 JP |
172 | return -EPROTONOSUPPORT; |
173 | } | |
174 | } else { | |
175 | push_proto = htons(ETH_P_8021Q); | |
176 | } | |
956af371 HHZ |
177 | |
178 | if (tb[TCA_VLAN_PUSH_VLAN_PRIORITY]) | |
179 | push_prio = nla_get_u8(tb[TCA_VLAN_PUSH_VLAN_PRIORITY]); | |
c7e2b968 JP |
180 | break; |
181 | default: | |
5026c9b1 | 182 | if (exists) |
65a206c0 | 183 | tcf_idr_release(*a, bind); |
0190c1d4 | 184 | else |
7be8ef2c | 185 | tcf_idr_cleanup(tn, index); |
c7e2b968 JP |
186 | return -EINVAL; |
187 | } | |
188 | action = parm->v_action; | |
189 | ||
5026c9b1 | 190 | if (!exists) { |
7be8ef2c | 191 | ret = tcf_idr_create(tn, index, est, a, |
e0496cbb | 192 | &act_vlan_ops, bind, true); |
0190c1d4 | 193 | if (ret) { |
7be8ef2c | 194 | tcf_idr_cleanup(tn, index); |
c7e2b968 | 195 | return ret; |
0190c1d4 | 196 | } |
c7e2b968 JP |
197 | |
198 | ret = ACT_P_CREATED; | |
4e8ddd7f | 199 | } else if (!ovr) { |
65a206c0 | 200 | tcf_idr_release(*a, bind); |
4e8ddd7f | 201 | return -EEXIST; |
c7e2b968 JP |
202 | } |
203 | ||
7e0c8892 DC |
204 | err = tcf_action_check_ctrlact(parm->action, tp, &goto_ch, extack); |
205 | if (err < 0) | |
206 | goto release_idr; | |
207 | ||
a85a970a | 208 | v = to_vlan(*a); |
c7e2b968 | 209 | |
4c5b9d96 MK |
210 | p = kzalloc(sizeof(*p), GFP_KERNEL); |
211 | if (!p) { | |
7e0c8892 DC |
212 | err = -ENOMEM; |
213 | goto put_chain; | |
4c5b9d96 | 214 | } |
c7e2b968 | 215 | |
4c5b9d96 MK |
216 | p->tcfv_action = action; |
217 | p->tcfv_push_vid = push_vid; | |
218 | p->tcfv_push_prio = push_prio; | |
219 | p->tcfv_push_proto = push_proto; | |
220 | ||
653cd284 | 221 | spin_lock_bh(&v->tcf_lock); |
7e0c8892 | 222 | goto_ch = tcf_action_set_ctrlact(*a, parm->action, goto_ch); |
764e9a24 | 223 | rcu_swap_protected(v->vlan_p, p, lockdep_is_held(&v->tcf_lock)); |
653cd284 | 224 | spin_unlock_bh(&v->tcf_lock); |
4c5b9d96 | 225 | |
7e0c8892 DC |
226 | if (goto_ch) |
227 | tcf_chain_put_by_act(goto_ch); | |
764e9a24 VB |
228 | if (p) |
229 | kfree_rcu(p, rcu); | |
c7e2b968 JP |
230 | |
231 | if (ret == ACT_P_CREATED) | |
65a206c0 | 232 | tcf_idr_insert(tn, *a); |
c7e2b968 | 233 | return ret; |
7e0c8892 DC |
234 | put_chain: |
235 | if (goto_ch) | |
236 | tcf_chain_put_by_act(goto_ch); | |
237 | release_idr: | |
238 | tcf_idr_release(*a, bind); | |
239 | return err; | |
c7e2b968 JP |
240 | } |
241 | ||
9a63b255 | 242 | static void tcf_vlan_cleanup(struct tc_action *a) |
4c5b9d96 MK |
243 | { |
244 | struct tcf_vlan *v = to_vlan(a); | |
245 | struct tcf_vlan_params *p; | |
246 | ||
247 | p = rcu_dereference_protected(v->vlan_p, 1); | |
1edf8abe DC |
248 | if (p) |
249 | kfree_rcu(p, rcu); | |
4c5b9d96 MK |
250 | } |
251 | ||
c7e2b968 JP |
252 | static int tcf_vlan_dump(struct sk_buff *skb, struct tc_action *a, |
253 | int bind, int ref) | |
254 | { | |
255 | unsigned char *b = skb_tail_pointer(skb); | |
a85a970a | 256 | struct tcf_vlan *v = to_vlan(a); |
764e9a24 | 257 | struct tcf_vlan_params *p; |
c7e2b968 JP |
258 | struct tc_vlan opt = { |
259 | .index = v->tcf_index, | |
036bb443 VB |
260 | .refcnt = refcount_read(&v->tcf_refcnt) - ref, |
261 | .bindcnt = atomic_read(&v->tcf_bindcnt) - bind, | |
c7e2b968 JP |
262 | }; |
263 | struct tcf_t t; | |
264 | ||
653cd284 | 265 | spin_lock_bh(&v->tcf_lock); |
764e9a24 VB |
266 | opt.action = v->tcf_action; |
267 | p = rcu_dereference_protected(v->vlan_p, lockdep_is_held(&v->tcf_lock)); | |
268 | opt.v_action = p->tcfv_action; | |
c7e2b968 JP |
269 | if (nla_put(skb, TCA_VLAN_PARMS, sizeof(opt), &opt)) |
270 | goto nla_put_failure; | |
271 | ||
4c5b9d96 MK |
272 | if ((p->tcfv_action == TCA_VLAN_ACT_PUSH || |
273 | p->tcfv_action == TCA_VLAN_ACT_MODIFY) && | |
274 | (nla_put_u16(skb, TCA_VLAN_PUSH_VLAN_ID, p->tcfv_push_vid) || | |
0b0f43fe | 275 | nla_put_be16(skb, TCA_VLAN_PUSH_VLAN_PROTOCOL, |
4c5b9d96 | 276 | p->tcfv_push_proto) || |
956af371 | 277 | (nla_put_u8(skb, TCA_VLAN_PUSH_VLAN_PRIORITY, |
4c5b9d96 | 278 | p->tcfv_push_prio)))) |
c7e2b968 JP |
279 | goto nla_put_failure; |
280 | ||
48d8ee16 | 281 | tcf_tm_dump(&t, &v->tcf_tm); |
9854518e | 282 | if (nla_put_64bit(skb, TCA_VLAN_TM, sizeof(t), &t, TCA_VLAN_PAD)) |
c7e2b968 | 283 | goto nla_put_failure; |
653cd284 | 284 | spin_unlock_bh(&v->tcf_lock); |
764e9a24 | 285 | |
c7e2b968 JP |
286 | return skb->len; |
287 | ||
288 | nla_put_failure: | |
653cd284 | 289 | spin_unlock_bh(&v->tcf_lock); |
c7e2b968 JP |
290 | nlmsg_trim(skb, b); |
291 | return -1; | |
292 | } | |
293 | ||
ddf97ccd WC |
294 | static int tcf_vlan_walker(struct net *net, struct sk_buff *skb, |
295 | struct netlink_callback *cb, int type, | |
41780105 AA |
296 | const struct tc_action_ops *ops, |
297 | struct netlink_ext_ack *extack) | |
ddf97ccd WC |
298 | { |
299 | struct tc_action_net *tn = net_generic(net, vlan_net_id); | |
300 | ||
b3620145 | 301 | return tcf_generic_walker(tn, skb, cb, type, ops, extack); |
ddf97ccd WC |
302 | } |
303 | ||
f061b48c | 304 | static int tcf_vlan_search(struct net *net, struct tc_action **a, u32 index) |
ddf97ccd WC |
305 | { |
306 | struct tc_action_net *tn = net_generic(net, vlan_net_id); | |
307 | ||
65a206c0 | 308 | return tcf_idr_search(tn, a, index); |
ddf97ccd WC |
309 | } |
310 | ||
b35475c5 RM |
311 | static size_t tcf_vlan_get_fill_size(const struct tc_action *act) |
312 | { | |
313 | return nla_total_size(sizeof(struct tc_vlan)) | |
314 | + nla_total_size(sizeof(u16)) /* TCA_VLAN_PUSH_VLAN_ID */ | |
315 | + nla_total_size(sizeof(u16)) /* TCA_VLAN_PUSH_VLAN_PROTOCOL */ | |
316 | + nla_total_size(sizeof(u8)); /* TCA_VLAN_PUSH_VLAN_PRIORITY */ | |
317 | } | |
318 | ||
c7e2b968 JP |
319 | static struct tc_action_ops act_vlan_ops = { |
320 | .kind = "vlan", | |
eddd2cf1 | 321 | .id = TCA_ID_VLAN, |
c7e2b968 | 322 | .owner = THIS_MODULE, |
8aa7f22e | 323 | .act = tcf_vlan_act, |
c7e2b968 JP |
324 | .dump = tcf_vlan_dump, |
325 | .init = tcf_vlan_init, | |
4c5b9d96 | 326 | .cleanup = tcf_vlan_cleanup, |
ddf97ccd | 327 | .walk = tcf_vlan_walker, |
b35475c5 | 328 | .get_fill_size = tcf_vlan_get_fill_size, |
ddf97ccd | 329 | .lookup = tcf_vlan_search, |
a85a970a | 330 | .size = sizeof(struct tcf_vlan), |
ddf97ccd WC |
331 | }; |
332 | ||
333 | static __net_init int vlan_init_net(struct net *net) | |
334 | { | |
335 | struct tc_action_net *tn = net_generic(net, vlan_net_id); | |
336 | ||
c7e460ce | 337 | return tc_action_net_init(tn, &act_vlan_ops); |
ddf97ccd WC |
338 | } |
339 | ||
039af9c6 | 340 | static void __net_exit vlan_exit_net(struct list_head *net_list) |
ddf97ccd | 341 | { |
039af9c6 | 342 | tc_action_net_exit(net_list, vlan_net_id); |
ddf97ccd WC |
343 | } |
344 | ||
345 | static struct pernet_operations vlan_net_ops = { | |
346 | .init = vlan_init_net, | |
039af9c6 | 347 | .exit_batch = vlan_exit_net, |
ddf97ccd WC |
348 | .id = &vlan_net_id, |
349 | .size = sizeof(struct tc_action_net), | |
c7e2b968 JP |
350 | }; |
351 | ||
352 | static int __init vlan_init_module(void) | |
353 | { | |
ddf97ccd | 354 | return tcf_register_action(&act_vlan_ops, &vlan_net_ops); |
c7e2b968 JP |
355 | } |
356 | ||
357 | static void __exit vlan_cleanup_module(void) | |
358 | { | |
ddf97ccd | 359 | tcf_unregister_action(&act_vlan_ops, &vlan_net_ops); |
c7e2b968 JP |
360 | } |
361 | ||
362 | module_init(vlan_init_module); | |
363 | module_exit(vlan_cleanup_module); | |
364 | ||
365 | MODULE_AUTHOR("Jiri Pirko <jiri@resnulli.us>"); | |
366 | MODULE_DESCRIPTION("vlan manipulation actions"); | |
367 | MODULE_LICENSE("GPL v2"); |