Commit | Line | Data |
---|---|---|
457c8996 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
243a2e63 VY |
2 | #include <linux/kernel.h> |
3 | #include <linux/netdevice.h> | |
4 | #include <linux/rtnetlink.h> | |
5 | #include <linux/slab.h> | |
7f109539 | 6 | #include <net/switchdev.h> |
243a2e63 VY |
7 | |
8 | #include "br_private.h" | |
efa5356b | 9 | #include "br_private_tunnel.h" |
243a2e63 | 10 | |
80900acd MM |
11 | static void nbp_vlan_set_vlan_dev_state(struct net_bridge_port *p, u16 vid); |
12 | ||
2594e906 NA |
13 | static inline int br_vlan_cmp(struct rhashtable_compare_arg *arg, |
14 | const void *ptr) | |
552406c4 | 15 | { |
2594e906 NA |
16 | const struct net_bridge_vlan *vle = ptr; |
17 | u16 vid = *(u16 *)arg->key; | |
18 | ||
19 | return vle->vid != vid; | |
20 | } | |
21 | ||
22 | static const struct rhashtable_params br_vlan_rht_params = { | |
23 | .head_offset = offsetof(struct net_bridge_vlan, vnode), | |
24 | .key_offset = offsetof(struct net_bridge_vlan, vid), | |
25 | .key_len = sizeof(u16), | |
8af78b64 | 26 | .nelem_hint = 3, |
2594e906 NA |
27 | .max_size = VLAN_N_VID, |
28 | .obj_cmpfn = br_vlan_cmp, | |
29 | .automatic_shrinking = true, | |
30 | }; | |
31 | ||
32 | static struct net_bridge_vlan *br_vlan_lookup(struct rhashtable *tbl, u16 vid) | |
33 | { | |
34 | return rhashtable_lookup_fast(tbl, &vid, br_vlan_rht_params); | |
35 | } | |
36 | ||
27c5f74c | 37 | static void __vlan_add_pvid(struct net_bridge_vlan_group *vg, |
a580c76d | 38 | const struct net_bridge_vlan *v) |
2594e906 | 39 | { |
a580c76d | 40 | if (vg->pvid == v->vid) |
27c5f74c | 41 | return; |
552406c4 VY |
42 | |
43 | smp_wmb(); | |
a580c76d NA |
44 | br_vlan_set_pvid_state(vg, v->state); |
45 | vg->pvid = v->vid; | |
552406c4 VY |
46 | } |
47 | ||
27c5f74c | 48 | static void __vlan_delete_pvid(struct net_bridge_vlan_group *vg, u16 vid) |
552406c4 | 49 | { |
77751ee8 | 50 | if (vg->pvid != vid) |
27c5f74c | 51 | return; |
552406c4 VY |
52 | |
53 | smp_wmb(); | |
77751ee8 | 54 | vg->pvid = 0; |
552406c4 VY |
55 | } |
56 | ||
27c5f74c VO |
57 | /* Update the BRIDGE_VLAN_INFO_PVID and BRIDGE_VLAN_INFO_UNTAGGED flags of @v. |
58 | * If @commit is false, return just whether the BRIDGE_VLAN_INFO_PVID and | |
59 | * BRIDGE_VLAN_INFO_UNTAGGED bits of @flags would produce any change onto @v. | |
cab2cd77 | 60 | */ |
27c5f74c VO |
61 | static bool __vlan_flags_update(struct net_bridge_vlan *v, u16 flags, |
62 | bool commit) | |
35e03f3a | 63 | { |
77751ee8 | 64 | struct net_bridge_vlan_group *vg; |
27c5f74c | 65 | bool change; |
77751ee8 NA |
66 | |
67 | if (br_vlan_is_master(v)) | |
907b1e6e | 68 | vg = br_vlan_group(v->br); |
77751ee8 | 69 | else |
907b1e6e | 70 | vg = nbp_vlan_group(v->port); |
77751ee8 | 71 | |
27c5f74c VO |
72 | /* check if anything would be changed on commit */ |
73 | change = !!(flags & BRIDGE_VLAN_INFO_PVID) == !!(vg->pvid != v->vid) || | |
74 | ((flags ^ v->flags) & BRIDGE_VLAN_INFO_UNTAGGED); | |
75 | ||
76 | if (!commit) | |
77 | goto out; | |
78 | ||
77751ee8 | 79 | if (flags & BRIDGE_VLAN_INFO_PVID) |
27c5f74c | 80 | __vlan_add_pvid(vg, v); |
77751ee8 | 81 | else |
27c5f74c | 82 | __vlan_delete_pvid(vg, v->vid); |
35e03f3a VY |
83 | |
84 | if (flags & BRIDGE_VLAN_INFO_UNTAGGED) | |
2594e906 | 85 | v->flags |= BRIDGE_VLAN_INFO_UNTAGGED; |
635126b7 | 86 | else |
2594e906 | 87 | v->flags &= ~BRIDGE_VLAN_INFO_UNTAGGED; |
f418af63 | 88 | |
27c5f74c VO |
89 | out: |
90 | return change; | |
91 | } | |
92 | ||
93 | static bool __vlan_flags_would_change(struct net_bridge_vlan *v, u16 flags) | |
94 | { | |
95 | return __vlan_flags_update(v, flags, false); | |
96 | } | |
97 | ||
98 | static void __vlan_flags_commit(struct net_bridge_vlan *v, u16 flags) | |
99 | { | |
100 | __vlan_flags_update(v, flags, true); | |
35e03f3a VY |
101 | } |
102 | ||
7f109539 | 103 | static int __vlan_vid_add(struct net_device *dev, struct net_bridge *br, |
27973793 IS |
104 | struct net_bridge_vlan *v, u16 flags, |
105 | struct netlink_ext_ack *extack) | |
7f109539 | 106 | { |
7f109539 SF |
107 | int err; |
108 | ||
0944d6b5 JP |
109 | /* Try switchdev op first. In case it is not supported, fallback to |
110 | * 8021q add. | |
7f109539 | 111 | */ |
8d23a54f | 112 | err = br_switchdev_port_vlan_add(dev, v->vid, flags, false, extack); |
0944d6b5 | 113 | if (err == -EOPNOTSUPP) |
27973793 IS |
114 | return vlan_vid_add(dev, br->vlan_proto, v->vid); |
115 | v->priv_flags |= BR_VLFLAG_ADDED_BY_SWITCHDEV; | |
7f109539 SF |
116 | return err; |
117 | } | |
118 | ||
2594e906 | 119 | static void __vlan_add_list(struct net_bridge_vlan *v) |
243a2e63 | 120 | { |
907b1e6e | 121 | struct net_bridge_vlan_group *vg; |
2594e906 NA |
122 | struct list_head *headp, *hpos; |
123 | struct net_bridge_vlan *vent; | |
bc9a25d2 | 124 | |
907b1e6e NA |
125 | if (br_vlan_is_master(v)) |
126 | vg = br_vlan_group(v->br); | |
127 | else | |
128 | vg = nbp_vlan_group(v->port); | |
129 | ||
130 | headp = &vg->vlan_list; | |
2594e906 NA |
131 | list_for_each_prev(hpos, headp) { |
132 | vent = list_entry(hpos, struct net_bridge_vlan, vlist); | |
040c1257 | 133 | if (v->vid >= vent->vid) |
2594e906 | 134 | break; |
243a2e63 | 135 | } |
586c2b57 | 136 | list_add_rcu(&v->vlist, hpos); |
2594e906 | 137 | } |
243a2e63 | 138 | |
2594e906 NA |
139 | static void __vlan_del_list(struct net_bridge_vlan *v) |
140 | { | |
586c2b57 | 141 | list_del_rcu(&v->vlist); |
243a2e63 VY |
142 | } |
143 | ||
bf361ad3 | 144 | static int __vlan_vid_del(struct net_device *dev, struct net_bridge *br, |
27973793 | 145 | const struct net_bridge_vlan *v) |
7f109539 | 146 | { |
0944d6b5 | 147 | int err; |
7f109539 | 148 | |
0944d6b5 JP |
149 | /* Try switchdev op first. In case it is not supported, fallback to |
150 | * 8021q del. | |
7f109539 | 151 | */ |
27973793 IS |
152 | err = br_switchdev_port_vlan_del(dev, v->vid); |
153 | if (!(v->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV)) | |
154 | vlan_vid_del(dev, br->vlan_proto, v->vid); | |
155 | return err == -EOPNOTSUPP ? 0 : err; | |
7f109539 SF |
156 | } |
157 | ||
4bbd026c | 158 | /* Returns a master vlan, if it didn't exist it gets created. In all cases |
f8ed289f NA |
159 | * a reference is taken to the master vlan before returning. |
160 | */ | |
169327d5 PM |
161 | static struct net_bridge_vlan * |
162 | br_vlan_get_master(struct net_bridge *br, u16 vid, | |
163 | struct netlink_ext_ack *extack) | |
f8ed289f | 164 | { |
907b1e6e | 165 | struct net_bridge_vlan_group *vg; |
f8ed289f NA |
166 | struct net_bridge_vlan *masterv; |
167 | ||
907b1e6e NA |
168 | vg = br_vlan_group(br); |
169 | masterv = br_vlan_find(vg, vid); | |
f8ed289f | 170 | if (!masterv) { |
f418af63 NA |
171 | bool changed; |
172 | ||
f8ed289f | 173 | /* missing global ctx, create it now */ |
169327d5 | 174 | if (br_vlan_add(br, vid, 0, &changed, extack)) |
f8ed289f | 175 | return NULL; |
907b1e6e | 176 | masterv = br_vlan_find(vg, vid); |
f8ed289f NA |
177 | if (WARN_ON(!masterv)) |
178 | return NULL; | |
0e5a82ef IS |
179 | refcount_set(&masterv->refcnt, 1); |
180 | return masterv; | |
f8ed289f | 181 | } |
25127759 | 182 | refcount_inc(&masterv->refcnt); |
f8ed289f NA |
183 | |
184 | return masterv; | |
185 | } | |
186 | ||
6dada9b1 NA |
187 | static void br_master_vlan_rcu_free(struct rcu_head *rcu) |
188 | { | |
189 | struct net_bridge_vlan *v; | |
190 | ||
191 | v = container_of(rcu, struct net_bridge_vlan, rcu); | |
192 | WARN_ON(!br_vlan_is_master(v)); | |
193 | free_percpu(v->stats); | |
194 | v->stats = NULL; | |
195 | kfree(v); | |
196 | } | |
197 | ||
f8ed289f NA |
198 | static void br_vlan_put_master(struct net_bridge_vlan *masterv) |
199 | { | |
907b1e6e NA |
200 | struct net_bridge_vlan_group *vg; |
201 | ||
f8ed289f NA |
202 | if (!br_vlan_is_master(masterv)) |
203 | return; | |
204 | ||
907b1e6e | 205 | vg = br_vlan_group(masterv->br); |
25127759 | 206 | if (refcount_dec_and_test(&masterv->refcnt)) { |
907b1e6e | 207 | rhashtable_remove_fast(&vg->vlan_hash, |
f8ed289f NA |
208 | &masterv->vnode, br_vlan_rht_params); |
209 | __vlan_del_list(masterv); | |
7b54aaaf | 210 | br_multicast_toggle_one_vlan(masterv, false); |
613d61db | 211 | br_multicast_ctx_deinit(&masterv->br_mcast_ctx); |
6dada9b1 | 212 | call_rcu(&masterv->rcu, br_master_vlan_rcu_free); |
f8ed289f NA |
213 | } |
214 | } | |
215 | ||
9163a0fc NA |
216 | static void nbp_vlan_rcu_free(struct rcu_head *rcu) |
217 | { | |
218 | struct net_bridge_vlan *v; | |
219 | ||
220 | v = container_of(rcu, struct net_bridge_vlan, rcu); | |
221 | WARN_ON(br_vlan_is_master(v)); | |
222 | /* if we had per-port stats configured then free them here */ | |
9d332e69 | 223 | if (v->priv_flags & BR_VLFLAG_PER_PORT_STATS) |
9163a0fc NA |
224 | free_percpu(v->stats); |
225 | v->stats = NULL; | |
226 | kfree(v); | |
227 | } | |
228 | ||
ec7328b5 TW |
229 | static void br_vlan_init_state(struct net_bridge_vlan *v) |
230 | { | |
231 | struct net_bridge *br; | |
232 | ||
233 | if (br_vlan_is_master(v)) | |
234 | br = v->br; | |
235 | else | |
236 | br = v->port->br; | |
237 | ||
238 | if (br_opt_get(br, BROPT_MST_ENABLED)) { | |
239 | br_mst_vlan_init_state(v); | |
240 | return; | |
241 | } | |
242 | ||
243 | v->state = BR_STATE_FORWARDING; | |
244 | v->msti = 0; | |
245 | } | |
246 | ||
2594e906 NA |
247 | /* This is the shared VLAN add function which works for both ports and bridge |
248 | * devices. There are four possible calls to this function in terms of the | |
249 | * vlan entry type: | |
250 | * 1. vlan is being added on a port (no master flags, global entry exists) | |
ddd611d3 | 251 | * 2. vlan is being added on a bridge (both master and brentry flags) |
2594e906 | 252 | * 3. vlan is being added on a port, but a global entry didn't exist which |
ddd611d3 | 253 | * is being created right now (master flag set, brentry flag unset), the |
2594e906 | 254 | * global entry is used for global per-vlan features, but not for filtering |
ddd611d3 | 255 | * 4. same as 3 but with both master and brentry flags set so the entry |
2594e906 NA |
256 | * will be used for filtering in both the port and the bridge |
257 | */ | |
169327d5 PM |
258 | static int __vlan_add(struct net_bridge_vlan *v, u16 flags, |
259 | struct netlink_ext_ack *extack) | |
243a2e63 | 260 | { |
2594e906 NA |
261 | struct net_bridge_vlan *masterv = NULL; |
262 | struct net_bridge_port *p = NULL; | |
6be144f6 | 263 | struct net_bridge_vlan_group *vg; |
2594e906 NA |
264 | struct net_device *dev; |
265 | struct net_bridge *br; | |
266 | int err; | |
267 | ||
268 | if (br_vlan_is_master(v)) { | |
269 | br = v->br; | |
270 | dev = br->dev; | |
907b1e6e | 271 | vg = br_vlan_group(br); |
2594e906 NA |
272 | } else { |
273 | p = v->port; | |
274 | br = p->br; | |
275 | dev = p->dev; | |
907b1e6e | 276 | vg = nbp_vlan_group(p); |
2594e906 NA |
277 | } |
278 | ||
279 | if (p) { | |
2594e906 NA |
280 | /* Add VLAN to the device filter if it is supported. |
281 | * This ensures tagged traffic enters the bridge when | |
282 | * promiscuous mode is disabled by br_manage_promisc(). | |
283 | */ | |
27973793 | 284 | err = __vlan_vid_add(dev, br, v, flags, extack); |
2594e906 NA |
285 | if (err) |
286 | goto out; | |
287 | ||
288 | /* need to work on the master vlan too */ | |
289 | if (flags & BRIDGE_VLAN_INFO_MASTER) { | |
f418af63 NA |
290 | bool changed; |
291 | ||
292 | err = br_vlan_add(br, v->vid, | |
293 | flags | BRIDGE_VLAN_INFO_BRENTRY, | |
169327d5 | 294 | &changed, extack); |
2594e906 NA |
295 | if (err) |
296 | goto out_filt; | |
f545923b NA |
297 | |
298 | if (changed) | |
299 | br_vlan_notify(br, NULL, v->vid, 0, | |
300 | RTM_NEWVLAN); | |
2594e906 NA |
301 | } |
302 | ||
169327d5 | 303 | masterv = br_vlan_get_master(br, v->vid, extack); |
ee4f52a8 ZC |
304 | if (!masterv) { |
305 | err = -ENOMEM; | |
f8ed289f | 306 | goto out_filt; |
ee4f52a8 | 307 | } |
2594e906 | 308 | v->brvlan = masterv; |
9163a0fc | 309 | if (br_opt_get(br, BROPT_VLAN_STATS_PER_PORT)) { |
281cc284 HK |
310 | v->stats = |
311 | netdev_alloc_pcpu_stats(struct pcpu_sw_netstats); | |
9163a0fc NA |
312 | if (!v->stats) { |
313 | err = -ENOMEM; | |
314 | goto out_filt; | |
315 | } | |
9d332e69 | 316 | v->priv_flags |= BR_VLFLAG_PER_PORT_STATS; |
9163a0fc NA |
317 | } else { |
318 | v->stats = masterv->stats; | |
319 | } | |
613d61db | 320 | br_multicast_port_ctx_init(p, v, &v->port_mcast_ctx); |
9c86ce2c | 321 | } else { |
3116ad06 VO |
322 | if (br_vlan_should_use(v)) { |
323 | err = br_switchdev_port_vlan_add(dev, v->vid, flags, | |
8d23a54f | 324 | false, extack); |
3116ad06 VO |
325 | if (err && err != -EOPNOTSUPP) |
326 | goto out; | |
327 | } | |
613d61db | 328 | br_multicast_ctx_init(br, v, &v->br_mcast_ctx); |
7b54aaaf | 329 | v->priv_flags |= BR_VLFLAG_GLOBAL_MCAST_ENABLED; |
2594e906 NA |
330 | } |
331 | ||
6be144f6 | 332 | /* Add the dev mac and count the vlan only if it's usable */ |
2594e906 | 333 | if (br_vlan_should_use(v)) { |
f6814fdc | 334 | err = br_fdb_add_local(br, p, dev->dev_addr, v->vid); |
2594e906 NA |
335 | if (err) { |
336 | br_err(br, "failed insert local address into bridge forwarding table\n"); | |
337 | goto out_filt; | |
338 | } | |
6be144f6 | 339 | vg->num_vlans++; |
2594e906 NA |
340 | } |
341 | ||
a580c76d | 342 | /* set the state before publishing */ |
ec7328b5 | 343 | br_vlan_init_state(v); |
a580c76d | 344 | |
6be144f6 NA |
345 | err = rhashtable_lookup_insert_fast(&vg->vlan_hash, &v->vnode, |
346 | br_vlan_rht_params); | |
2594e906 NA |
347 | if (err) |
348 | goto out_fdb_insert; | |
243a2e63 | 349 | |
2594e906 | 350 | __vlan_add_list(v); |
27c5f74c | 351 | __vlan_flags_commit(v, flags); |
7b54aaaf | 352 | br_multicast_toggle_one_vlan(v, true); |
80900acd MM |
353 | |
354 | if (p) | |
355 | nbp_vlan_set_vlan_dev_state(p, v->vid); | |
2594e906 NA |
356 | out: |
357 | return err; | |
358 | ||
359 | out_fdb_insert: | |
6be144f6 NA |
360 | if (br_vlan_should_use(v)) { |
361 | br_fdb_find_delete_local(br, p, dev->dev_addr, v->vid); | |
362 | vg->num_vlans--; | |
363 | } | |
2594e906 NA |
364 | |
365 | out_filt: | |
366 | if (p) { | |
27973793 | 367 | __vlan_vid_del(dev, br, v); |
2594e906 | 368 | if (masterv) { |
1a3aea25 LR |
369 | if (v->stats && masterv->stats != v->stats) |
370 | free_percpu(v->stats); | |
371 | v->stats = NULL; | |
372 | ||
f8ed289f | 373 | br_vlan_put_master(masterv); |
2594e906 NA |
374 | v->brvlan = NULL; |
375 | } | |
9c86ce2c PM |
376 | } else { |
377 | br_switchdev_port_vlan_del(dev, v->vid); | |
2594e906 NA |
378 | } |
379 | ||
380 | goto out; | |
381 | } | |
382 | ||
383 | static int __vlan_del(struct net_bridge_vlan *v) | |
384 | { | |
385 | struct net_bridge_vlan *masterv = v; | |
77751ee8 | 386 | struct net_bridge_vlan_group *vg; |
2594e906 | 387 | struct net_bridge_port *p = NULL; |
2594e906 | 388 | int err = 0; |
552406c4 | 389 | |
2594e906 | 390 | if (br_vlan_is_master(v)) { |
907b1e6e | 391 | vg = br_vlan_group(v->br); |
2594e906 NA |
392 | } else { |
393 | p = v->port; | |
907b1e6e | 394 | vg = nbp_vlan_group(v->port); |
2594e906 | 395 | masterv = v->brvlan; |
2594e906 | 396 | } |
bf361ad3 | 397 | |
77751ee8 | 398 | __vlan_delete_pvid(vg, v->vid); |
2594e906 | 399 | if (p) { |
27973793 | 400 | err = __vlan_vid_del(p->dev, p->br, v); |
bf361ad3 | 401 | if (err) |
2594e906 | 402 | goto out; |
9c86ce2c PM |
403 | } else { |
404 | err = br_switchdev_port_vlan_del(v->br->dev, v->vid); | |
405 | if (err && err != -EOPNOTSUPP) | |
406 | goto out; | |
407 | err = 0; | |
8580e211 | 408 | } |
243a2e63 | 409 | |
6be144f6 NA |
410 | if (br_vlan_should_use(v)) { |
411 | v->flags &= ~BRIDGE_VLAN_INFO_BRENTRY; | |
412 | vg->num_vlans--; | |
2594e906 NA |
413 | } |
414 | ||
415 | if (masterv != v) { | |
efa5356b | 416 | vlan_tunnel_info_del(vg, v); |
77751ee8 NA |
417 | rhashtable_remove_fast(&vg->vlan_hash, &v->vnode, |
418 | br_vlan_rht_params); | |
2594e906 | 419 | __vlan_del_list(v); |
80900acd | 420 | nbp_vlan_set_vlan_dev_state(p, v->vid); |
7b54aaaf | 421 | br_multicast_toggle_one_vlan(v, false); |
613d61db | 422 | br_multicast_port_ctx_deinit(&v->port_mcast_ctx); |
9163a0fc | 423 | call_rcu(&v->rcu, nbp_vlan_rcu_free); |
243a2e63 | 424 | } |
2594e906 | 425 | |
f8ed289f | 426 | br_vlan_put_master(masterv); |
2594e906 NA |
427 | out: |
428 | return err; | |
243a2e63 VY |
429 | } |
430 | ||
f409d0ed NA |
431 | static void __vlan_group_free(struct net_bridge_vlan_group *vg) |
432 | { | |
433 | WARN_ON(!list_empty(&vg->vlan_list)); | |
434 | rhashtable_destroy(&vg->vlan_hash); | |
efa5356b | 435 | vlan_tunnel_deinit(vg); |
f409d0ed NA |
436 | kfree(vg); |
437 | } | |
438 | ||
f545923b NA |
439 | static void __vlan_flush(const struct net_bridge *br, |
440 | const struct net_bridge_port *p, | |
441 | struct net_bridge_vlan_group *vg) | |
243a2e63 | 442 | { |
2594e906 | 443 | struct net_bridge_vlan *vlan, *tmp; |
f545923b | 444 | u16 v_start = 0, v_end = 0; |
5454f5c2 | 445 | int err; |
2594e906 | 446 | |
f409d0ed | 447 | __vlan_delete_pvid(vg, vg->pvid); |
f545923b NA |
448 | list_for_each_entry_safe(vlan, tmp, &vg->vlan_list, vlist) { |
449 | /* take care of disjoint ranges */ | |
450 | if (!v_start) { | |
451 | v_start = vlan->vid; | |
452 | } else if (vlan->vid - v_end != 1) { | |
453 | /* found range end, notify and start next one */ | |
454 | br_vlan_notify(br, p, v_start, v_end, RTM_DELVLAN); | |
455 | v_start = vlan->vid; | |
456 | } | |
457 | v_end = vlan->vid; | |
458 | ||
5454f5c2 VO |
459 | err = __vlan_del(vlan); |
460 | if (err) { | |
461 | br_err(br, | |
462 | "port %u(%s) failed to delete vlan %d: %pe\n", | |
463 | (unsigned int) p->port_no, p->dev->name, | |
464 | vlan->vid, ERR_PTR(err)); | |
465 | } | |
f545923b NA |
466 | } |
467 | ||
468 | /* notify about the last/whole vlan range */ | |
469 | if (v_start) | |
470 | br_vlan_notify(br, p, v_start, v_end, RTM_DELVLAN); | |
243a2e63 VY |
471 | } |
472 | ||
78851988 | 473 | struct sk_buff *br_handle_vlan(struct net_bridge *br, |
11538d03 | 474 | const struct net_bridge_port *p, |
2594e906 | 475 | struct net_bridge_vlan_group *vg, |
78851988 | 476 | struct sk_buff *skb) |
a37b85c9 | 477 | { |
281cc284 | 478 | struct pcpu_sw_netstats *stats; |
2594e906 | 479 | struct net_bridge_vlan *v; |
a37b85c9 VY |
480 | u16 vid; |
481 | ||
20adfa1a VY |
482 | /* If this packet was not filtered at input, let it pass */ |
483 | if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) | |
78851988 VY |
484 | goto out; |
485 | ||
2594e906 NA |
486 | /* At this point, we know that the frame was filtered and contains |
487 | * a valid vlan id. If the vlan id has untagged flag set, | |
488 | * send untagged; otherwise, send tagged. | |
489 | */ | |
490 | br_vlan_get_tag(skb, &vid); | |
491 | v = br_vlan_find(vg, vid); | |
492 | /* Vlan entry must be configured at this point. The | |
fc92f745 VY |
493 | * only exception is the bridge is set in promisc mode and the |
494 | * packet is destined for the bridge device. In this case | |
495 | * pass the packet as is. | |
496 | */ | |
2594e906 | 497 | if (!v || !br_vlan_should_use(v)) { |
fc92f745 VY |
498 | if ((br->dev->flags & IFF_PROMISC) && skb->dev == br->dev) { |
499 | goto out; | |
500 | } else { | |
501 | kfree_skb(skb); | |
502 | return NULL; | |
503 | } | |
504 | } | |
ae75767e | 505 | if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { |
6dada9b1 NA |
506 | stats = this_cpu_ptr(v->stats); |
507 | u64_stats_update_begin(&stats->syncp); | |
9962acef ED |
508 | u64_stats_add(&stats->tx_bytes, skb->len); |
509 | u64_stats_inc(&stats->tx_packets); | |
6dada9b1 NA |
510 | u64_stats_update_end(&stats->syncp); |
511 | } | |
512 | ||
47211192 TW |
513 | /* If the skb will be sent using forwarding offload, the assumption is |
514 | * that the switchdev will inject the packet into hardware together | |
515 | * with the bridge VLAN, so that it can be forwarded according to that | |
516 | * VLAN. The switchdev should deal with popping the VLAN header in | |
517 | * hardware on each egress port as appropriate. So only strip the VLAN | |
518 | * header if forwarding offload is not being used. | |
519 | */ | |
520 | if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED && | |
521 | !br_switchdev_frame_uses_tx_fwd_offload(skb)) | |
5978f8a9 | 522 | __vlan_hwaccel_clear_tag(skb); |
11538d03 RP |
523 | |
524 | if (p && (p->flags & BR_VLAN_TUNNEL) && | |
525 | br_handle_egress_vlan_tunnel(skb, v)) { | |
526 | kfree_skb(skb); | |
527 | return NULL; | |
528 | } | |
78851988 VY |
529 | out: |
530 | return skb; | |
531 | } | |
532 | ||
533 | /* Called under RCU */ | |
6dada9b1 NA |
534 | static bool __allowed_ingress(const struct net_bridge *br, |
535 | struct net_bridge_vlan_group *vg, | |
a580c76d | 536 | struct sk_buff *skb, u16 *vid, |
f4b7002a NA |
537 | u8 *state, |
538 | struct net_bridge_vlan **vlan) | |
78851988 | 539 | { |
281cc284 | 540 | struct pcpu_sw_netstats *stats; |
6dada9b1 | 541 | struct net_bridge_vlan *v; |
8580e211 | 542 | bool tagged; |
a37b85c9 | 543 | |
20adfa1a | 544 | BR_INPUT_SKB_CB(skb)->vlan_filtered = true; |
12464bb8 TM |
545 | /* If vlan tx offload is disabled on bridge device and frame was |
546 | * sent from vlan device on the bridge device, it does not have | |
547 | * HW accelerated vlan tag. | |
548 | */ | |
df8a39de | 549 | if (unlikely(!skb_vlan_tag_present(skb) && |
6dada9b1 | 550 | skb->protocol == br->vlan_proto)) { |
0d5501c1 | 551 | skb = skb_vlan_untag(skb); |
12464bb8 TM |
552 | if (unlikely(!skb)) |
553 | return false; | |
554 | } | |
555 | ||
8580e211 TM |
556 | if (!br_vlan_get_tag(skb, vid)) { |
557 | /* Tagged frame */ | |
6dada9b1 | 558 | if (skb->vlan_proto != br->vlan_proto) { |
8580e211 TM |
559 | /* Protocol-mismatch, empty out vlan_tci for new tag */ |
560 | skb_push(skb, ETH_HLEN); | |
62749e2c | 561 | skb = vlan_insert_tag_set_proto(skb, skb->vlan_proto, |
df8a39de | 562 | skb_vlan_tag_get(skb)); |
8580e211 TM |
563 | if (unlikely(!skb)) |
564 | return false; | |
565 | ||
566 | skb_pull(skb, ETH_HLEN); | |
567 | skb_reset_mac_len(skb); | |
568 | *vid = 0; | |
569 | tagged = false; | |
570 | } else { | |
571 | tagged = true; | |
572 | } | |
573 | } else { | |
574 | /* Untagged frame */ | |
575 | tagged = false; | |
576 | } | |
577 | ||
b90356ce | 578 | if (!*vid) { |
77751ee8 NA |
579 | u16 pvid = br_get_pvid(vg); |
580 | ||
b90356ce TM |
581 | /* Frame had a tag with VID 0 or did not have a tag. |
582 | * See if pvid is set on this port. That tells us which | |
583 | * vlan untagged or priority-tagged traffic belongs to. | |
78851988 | 584 | */ |
3df6bf45 | 585 | if (!pvid) |
eb707618 | 586 | goto drop; |
78851988 | 587 | |
b90356ce TM |
588 | /* PVID is set on this port. Any untagged or priority-tagged |
589 | * ingress frame is considered to belong to this vlan. | |
78851988 | 590 | */ |
dfb5fa32 | 591 | *vid = pvid; |
8580e211 | 592 | if (likely(!tagged)) |
b90356ce | 593 | /* Untagged Frame. */ |
6dada9b1 | 594 | __vlan_hwaccel_put_tag(skb, br->vlan_proto, pvid); |
b90356ce TM |
595 | else |
596 | /* Priority-tagged Frame. | |
5978f8a9 MM |
597 | * At this point, we know that skb->vlan_tci VID |
598 | * field was 0. | |
b90356ce TM |
599 | * We update only VID field and preserve PCP field. |
600 | */ | |
601 | skb->vlan_tci |= pvid; | |
602 | ||
f4b7002a NA |
603 | /* if snooping and stats are disabled we can avoid the lookup */ |
604 | if (!br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) && | |
605 | !br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { | |
a580c76d NA |
606 | if (*state == BR_STATE_FORWARDING) { |
607 | *state = br_vlan_get_pvid_state(vg); | |
fd20d973 TY |
608 | if (!br_vlan_state_allowed(*state, true)) |
609 | goto drop; | |
a580c76d | 610 | } |
fd20d973 | 611 | return true; |
a580c76d | 612 | } |
78851988 | 613 | } |
77751ee8 | 614 | v = br_vlan_find(vg, *vid); |
6dada9b1 NA |
615 | if (!v || !br_vlan_should_use(v)) |
616 | goto drop; | |
617 | ||
a580c76d NA |
618 | if (*state == BR_STATE_FORWARDING) { |
619 | *state = br_vlan_get_state(v); | |
620 | if (!br_vlan_state_allowed(*state, true)) | |
621 | goto drop; | |
622 | } | |
623 | ||
ae75767e | 624 | if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) { |
6dada9b1 NA |
625 | stats = this_cpu_ptr(v->stats); |
626 | u64_stats_update_begin(&stats->syncp); | |
9962acef ED |
627 | u64_stats_add(&stats->rx_bytes, skb->len); |
628 | u64_stats_inc(&stats->rx_packets); | |
6dada9b1 NA |
629 | u64_stats_update_end(&stats->syncp); |
630 | } | |
631 | ||
f4b7002a NA |
632 | *vlan = v; |
633 | ||
6dada9b1 NA |
634 | return true; |
635 | ||
eb707618 TM |
636 | drop: |
637 | kfree_skb(skb); | |
a37b85c9 VY |
638 | return false; |
639 | } | |
640 | ||
77751ee8 NA |
641 | bool br_allowed_ingress(const struct net_bridge *br, |
642 | struct net_bridge_vlan_group *vg, struct sk_buff *skb, | |
f4b7002a NA |
643 | u16 *vid, u8 *state, |
644 | struct net_bridge_vlan **vlan) | |
2594e906 NA |
645 | { |
646 | /* If VLAN filtering is disabled on the bridge, all packets are | |
647 | * permitted. | |
648 | */ | |
f4b7002a | 649 | *vlan = NULL; |
ae75767e | 650 | if (!br_opt_get(br, BROPT_VLAN_ENABLED)) { |
2594e906 NA |
651 | BR_INPUT_SKB_CB(skb)->vlan_filtered = false; |
652 | return true; | |
653 | } | |
654 | ||
f4b7002a | 655 | return __allowed_ingress(br, vg, skb, vid, state, vlan); |
2594e906 NA |
656 | } |
657 | ||
85f46c6b | 658 | /* Called under RCU. */ |
2594e906 | 659 | bool br_allowed_egress(struct net_bridge_vlan_group *vg, |
85f46c6b VY |
660 | const struct sk_buff *skb) |
661 | { | |
2594e906 | 662 | const struct net_bridge_vlan *v; |
85f46c6b VY |
663 | u16 vid; |
664 | ||
20adfa1a VY |
665 | /* If this packet was not filtered at input, let it pass */ |
666 | if (!BR_INPUT_SKB_CB(skb)->vlan_filtered) | |
85f46c6b VY |
667 | return true; |
668 | ||
85f46c6b | 669 | br_vlan_get_tag(skb, &vid); |
2594e906 | 670 | v = br_vlan_find(vg, vid); |
a580c76d NA |
671 | if (v && br_vlan_should_use(v) && |
672 | br_vlan_state_allowed(br_vlan_get_state(v), false)) | |
85f46c6b VY |
673 | return true; |
674 | ||
675 | return false; | |
676 | } | |
677 | ||
e0d7968a TM |
678 | /* Called under RCU */ |
679 | bool br_should_learn(struct net_bridge_port *p, struct sk_buff *skb, u16 *vid) | |
680 | { | |
468e7944 | 681 | struct net_bridge_vlan_group *vg; |
e0d7968a | 682 | struct net_bridge *br = p->br; |
a580c76d | 683 | struct net_bridge_vlan *v; |
e0d7968a | 684 | |
20adfa1a | 685 | /* If filtering was disabled at input, let it pass. */ |
ae75767e | 686 | if (!br_opt_get(br, BROPT_VLAN_ENABLED)) |
e0d7968a TM |
687 | return true; |
688 | ||
eca1e006 | 689 | vg = nbp_vlan_group_rcu(p); |
468e7944 | 690 | if (!vg || !vg->num_vlans) |
e0d7968a TM |
691 | return false; |
692 | ||
8580e211 TM |
693 | if (!br_vlan_get_tag(skb, vid) && skb->vlan_proto != br->vlan_proto) |
694 | *vid = 0; | |
695 | ||
e0d7968a | 696 | if (!*vid) { |
77751ee8 | 697 | *vid = br_get_pvid(vg); |
a580c76d NA |
698 | if (!*vid || |
699 | !br_vlan_state_allowed(br_vlan_get_pvid_state(vg), true)) | |
e0d7968a TM |
700 | return false; |
701 | ||
702 | return true; | |
703 | } | |
704 | ||
a580c76d NA |
705 | v = br_vlan_find(vg, *vid); |
706 | if (v && br_vlan_state_allowed(br_vlan_get_state(v), true)) | |
e0d7968a TM |
707 | return true; |
708 | ||
709 | return false; | |
710 | } | |
711 | ||
dbd6dc75 PM |
712 | static int br_vlan_add_existing(struct net_bridge *br, |
713 | struct net_bridge_vlan_group *vg, | |
714 | struct net_bridge_vlan *vlan, | |
169327d5 PM |
715 | u16 flags, bool *changed, |
716 | struct netlink_ext_ack *extack) | |
dbd6dc75 | 717 | { |
27c5f74c | 718 | bool becomes_brentry = false; |
eb25de13 | 719 | bool would_change = false; |
dbd6dc75 PM |
720 | int err; |
721 | ||
27c5f74c VO |
722 | if (!br_vlan_is_brentry(vlan)) { |
723 | /* Trying to change flags of non-existent bridge vlan */ | |
724 | if (!(flags & BRIDGE_VLAN_INFO_BRENTRY)) | |
725 | return -EINVAL; | |
b2bc58d4 | 726 | |
27c5f74c | 727 | becomes_brentry = true; |
eb25de13 JG |
728 | } else { |
729 | would_change = __vlan_flags_would_change(vlan, flags); | |
27c5f74c | 730 | } |
9c86ce2c | 731 | |
27c5f74c VO |
732 | /* Master VLANs that aren't brentries weren't notified before, |
733 | * time to notify them now. | |
734 | */ | |
735 | if (becomes_brentry || would_change) { | |
736 | err = br_switchdev_port_vlan_add(br->dev, vlan->vid, flags, | |
8d23a54f | 737 | would_change, extack); |
27c5f74c VO |
738 | if (err && err != -EOPNOTSUPP) |
739 | return err; | |
740 | } | |
741 | ||
742 | if (becomes_brentry) { | |
dbd6dc75 | 743 | /* It was only kept for port vlans, now make it real */ |
f6814fdc | 744 | err = br_fdb_add_local(br, NULL, br->dev->dev_addr, vlan->vid); |
dbd6dc75 PM |
745 | if (err) { |
746 | br_err(br, "failed to insert local address into bridge forwarding table\n"); | |
9c86ce2c | 747 | goto err_fdb_insert; |
dbd6dc75 PM |
748 | } |
749 | ||
750 | refcount_inc(&vlan->refcnt); | |
751 | vlan->flags |= BRIDGE_VLAN_INFO_BRENTRY; | |
752 | vg->num_vlans++; | |
753 | *changed = true; | |
b92dace3 | 754 | br_multicast_toggle_one_vlan(vlan, true); |
dbd6dc75 PM |
755 | } |
756 | ||
27c5f74c VO |
757 | __vlan_flags_commit(vlan, flags); |
758 | if (would_change) | |
dbd6dc75 PM |
759 | *changed = true; |
760 | ||
761 | return 0; | |
9c86ce2c PM |
762 | |
763 | err_fdb_insert: | |
9c86ce2c PM |
764 | br_switchdev_port_vlan_del(br->dev, vlan->vid); |
765 | return err; | |
dbd6dc75 PM |
766 | } |
767 | ||
8adff41c TM |
768 | /* Must be protected by RTNL. |
769 | * Must be called with vid in range from 1 to 4094 inclusive. | |
f418af63 | 770 | * changed must be true only if the vlan was created or updated |
8adff41c | 771 | */ |
169327d5 PM |
772 | int br_vlan_add(struct net_bridge *br, u16 vid, u16 flags, bool *changed, |
773 | struct netlink_ext_ack *extack) | |
243a2e63 | 774 | { |
907b1e6e | 775 | struct net_bridge_vlan_group *vg; |
2594e906 NA |
776 | struct net_bridge_vlan *vlan; |
777 | int ret; | |
243a2e63 VY |
778 | |
779 | ASSERT_RTNL(); | |
780 | ||
f418af63 | 781 | *changed = false; |
907b1e6e NA |
782 | vg = br_vlan_group(br); |
783 | vlan = br_vlan_find(vg, vid); | |
dbd6dc75 | 784 | if (vlan) |
169327d5 PM |
785 | return br_vlan_add_existing(br, vg, vlan, flags, changed, |
786 | extack); | |
243a2e63 | 787 | |
2594e906 NA |
788 | vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); |
789 | if (!vlan) | |
243a2e63 VY |
790 | return -ENOMEM; |
791 | ||
281cc284 | 792 | vlan->stats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats); |
6dada9b1 NA |
793 | if (!vlan->stats) { |
794 | kfree(vlan); | |
795 | return -ENOMEM; | |
796 | } | |
2594e906 NA |
797 | vlan->vid = vid; |
798 | vlan->flags = flags | BRIDGE_VLAN_INFO_MASTER; | |
799 | vlan->flags &= ~BRIDGE_VLAN_INFO_PVID; | |
800 | vlan->br = br; | |
801 | if (flags & BRIDGE_VLAN_INFO_BRENTRY) | |
25127759 | 802 | refcount_set(&vlan->refcnt, 1); |
169327d5 | 803 | ret = __vlan_add(vlan, flags, extack); |
6dada9b1 NA |
804 | if (ret) { |
805 | free_percpu(vlan->stats); | |
2594e906 | 806 | kfree(vlan); |
f418af63 NA |
807 | } else { |
808 | *changed = true; | |
6dada9b1 | 809 | } |
243a2e63 | 810 | |
2594e906 | 811 | return ret; |
243a2e63 VY |
812 | } |
813 | ||
8adff41c TM |
814 | /* Must be protected by RTNL. |
815 | * Must be called with vid in range from 1 to 4094 inclusive. | |
816 | */ | |
243a2e63 VY |
817 | int br_vlan_delete(struct net_bridge *br, u16 vid) |
818 | { | |
907b1e6e | 819 | struct net_bridge_vlan_group *vg; |
2594e906 | 820 | struct net_bridge_vlan *v; |
243a2e63 VY |
821 | |
822 | ASSERT_RTNL(); | |
823 | ||
907b1e6e NA |
824 | vg = br_vlan_group(br); |
825 | v = br_vlan_find(vg, vid); | |
2594e906 NA |
826 | if (!v || !br_vlan_is_brentry(v)) |
827 | return -ENOENT; | |
243a2e63 | 828 | |
424bb9c9 | 829 | br_fdb_find_delete_local(br, NULL, br->dev->dev_addr, vid); |
3741873b | 830 | br_fdb_delete_by_port(br, NULL, vid, 0); |
bc9a25d2 | 831 | |
efa5356b RP |
832 | vlan_tunnel_info_del(vg, v); |
833 | ||
2594e906 | 834 | return __vlan_del(v); |
243a2e63 VY |
835 | } |
836 | ||
837 | void br_vlan_flush(struct net_bridge *br) | |
838 | { | |
f409d0ed NA |
839 | struct net_bridge_vlan_group *vg; |
840 | ||
243a2e63 | 841 | ASSERT_RTNL(); |
243a2e63 | 842 | |
f409d0ed | 843 | vg = br_vlan_group(br); |
f545923b | 844 | __vlan_flush(br, NULL, vg); |
f409d0ed | 845 | RCU_INIT_POINTER(br->vlgrp, NULL); |
48ebf6eb | 846 | synchronize_net(); |
f409d0ed | 847 | __vlan_group_free(vg); |
243a2e63 VY |
848 | } |
849 | ||
2594e906 | 850 | struct net_bridge_vlan *br_vlan_find(struct net_bridge_vlan_group *vg, u16 vid) |
2b292fb4 | 851 | { |
2594e906 NA |
852 | if (!vg) |
853 | return NULL; | |
2b292fb4 | 854 | |
2594e906 | 855 | return br_vlan_lookup(&vg->vlan_hash, vid); |
2b292fb4 TM |
856 | } |
857 | ||
204177f3 TM |
858 | /* Must be protected by RTNL. */ |
859 | static void recalculate_group_addr(struct net_bridge *br) | |
860 | { | |
be3664a0 | 861 | if (br_opt_get(br, BROPT_GROUP_ADDR_SET)) |
204177f3 TM |
862 | return; |
863 | ||
864 | spin_lock_bh(&br->lock); | |
ae75767e NA |
865 | if (!br_opt_get(br, BROPT_VLAN_ENABLED) || |
866 | br->vlan_proto == htons(ETH_P_8021Q)) { | |
204177f3 TM |
867 | /* Bridge Group Address */ |
868 | br->group_addr[5] = 0x00; | |
869 | } else { /* vlan_enabled && ETH_P_8021AD */ | |
870 | /* Provider Bridge Group Address */ | |
871 | br->group_addr[5] = 0x08; | |
872 | } | |
873 | spin_unlock_bh(&br->lock); | |
874 | } | |
875 | ||
876 | /* Must be protected by RTNL. */ | |
877 | void br_recalculate_fwd_mask(struct net_bridge *br) | |
878 | { | |
ae75767e NA |
879 | if (!br_opt_get(br, BROPT_VLAN_ENABLED) || |
880 | br->vlan_proto == htons(ETH_P_8021Q)) | |
204177f3 TM |
881 | br->group_fwd_mask_required = BR_GROUPFWD_DEFAULT; |
882 | else /* vlan_enabled && ETH_P_8021AD */ | |
883 | br->group_fwd_mask_required = BR_GROUPFWD_8021AD & | |
884 | ~(1u << br->group_addr[5]); | |
885 | } | |
886 | ||
9e781401 VO |
887 | int br_vlan_filter_toggle(struct net_bridge *br, unsigned long val, |
888 | struct netlink_ext_ack *extack) | |
243a2e63 | 889 | { |
6b72a770 ER |
890 | struct switchdev_attr attr = { |
891 | .orig_dev = br->dev, | |
892 | .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, | |
893 | .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, | |
894 | .u.vlan_filtering = val, | |
895 | }; | |
896 | int err; | |
897 | ||
ae75767e | 898 | if (br_opt_get(br, BROPT_VLAN_ENABLED) == !!val) |
a7854037 | 899 | return 0; |
243a2e63 | 900 | |
f7cdb3ec VO |
901 | br_opt_toggle(br, BROPT_VLAN_ENABLED, !!val); |
902 | ||
dcbdf135 | 903 | err = switchdev_port_attr_set(br->dev, &attr, extack); |
f7cdb3ec VO |
904 | if (err && err != -EOPNOTSUPP) { |
905 | br_opt_toggle(br, BROPT_VLAN_ENABLED, !val); | |
6b72a770 | 906 | return err; |
f7cdb3ec | 907 | } |
6b72a770 | 908 | |
2796d0c6 | 909 | br_manage_promisc(br); |
204177f3 TM |
910 | recalculate_group_addr(br); |
911 | br_recalculate_fwd_mask(br); | |
f4b7002a NA |
912 | if (!val && br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) { |
913 | br_info(br, "vlan filtering disabled, automatically disabling multicast vlan snooping\n"); | |
914 | br_multicast_toggle_vlan_snooping(br, false, NULL); | |
915 | } | |
243a2e63 | 916 | |
a7854037 NA |
917 | return 0; |
918 | } | |
919 | ||
1f51445a IS |
920 | bool br_vlan_enabled(const struct net_device *dev) |
921 | { | |
922 | struct net_bridge *br = netdev_priv(dev); | |
923 | ||
ae75767e | 924 | return br_opt_get(br, BROPT_VLAN_ENABLED); |
1f51445a IS |
925 | } |
926 | EXPORT_SYMBOL_GPL(br_vlan_enabled); | |
927 | ||
31aed46f | 928 | int br_vlan_get_proto(const struct net_device *dev, u16 *p_proto) |
929 | { | |
930 | struct net_bridge *br = netdev_priv(dev); | |
931 | ||
932 | *p_proto = ntohs(br->vlan_proto); | |
933 | ||
934 | return 0; | |
935 | } | |
936 | EXPORT_SYMBOL_GPL(br_vlan_get_proto); | |
937 | ||
dcbdf135 VO |
938 | int __br_vlan_set_proto(struct net_bridge *br, __be16 proto, |
939 | struct netlink_ext_ack *extack) | |
204177f3 | 940 | { |
22ec19f3 DR |
941 | struct switchdev_attr attr = { |
942 | .orig_dev = br->dev, | |
943 | .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_PROTOCOL, | |
944 | .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, | |
945 | .u.vlan_protocol = ntohs(proto), | |
946 | }; | |
204177f3 TM |
947 | int err = 0; |
948 | struct net_bridge_port *p; | |
2594e906 | 949 | struct net_bridge_vlan *vlan; |
907b1e6e | 950 | struct net_bridge_vlan_group *vg; |
22ec19f3 | 951 | __be16 oldproto = br->vlan_proto; |
204177f3 | 952 | |
204177f3 | 953 | if (br->vlan_proto == proto) |
d2d427b3 | 954 | return 0; |
204177f3 | 955 | |
dcbdf135 | 956 | err = switchdev_port_attr_set(br->dev, &attr, extack); |
22ec19f3 DR |
957 | if (err && err != -EOPNOTSUPP) |
958 | return err; | |
959 | ||
204177f3 TM |
960 | /* Add VLANs for the new proto to the device filter. */ |
961 | list_for_each_entry(p, &br->port_list, list) { | |
907b1e6e NA |
962 | vg = nbp_vlan_group(p); |
963 | list_for_each_entry(vlan, &vg->vlan_list, vlist) { | |
9d45921e IS |
964 | if (vlan->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV) |
965 | continue; | |
2594e906 | 966 | err = vlan_vid_add(p->dev, proto, vlan->vid); |
204177f3 TM |
967 | if (err) |
968 | goto err_filt; | |
969 | } | |
970 | } | |
971 | ||
204177f3 TM |
972 | br->vlan_proto = proto; |
973 | ||
974 | recalculate_group_addr(br); | |
975 | br_recalculate_fwd_mask(br); | |
976 | ||
977 | /* Delete VLANs for the old proto from the device filter. */ | |
907b1e6e NA |
978 | list_for_each_entry(p, &br->port_list, list) { |
979 | vg = nbp_vlan_group(p); | |
9d45921e IS |
980 | list_for_each_entry(vlan, &vg->vlan_list, vlist) { |
981 | if (vlan->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV) | |
982 | continue; | |
2594e906 | 983 | vlan_vid_del(p->dev, oldproto, vlan->vid); |
9d45921e | 984 | } |
907b1e6e | 985 | } |
204177f3 | 986 | |
d2d427b3 | 987 | return 0; |
204177f3 TM |
988 | |
989 | err_filt: | |
22ec19f3 | 990 | attr.u.vlan_protocol = ntohs(oldproto); |
dcbdf135 | 991 | switchdev_port_attr_set(br->dev, &attr, NULL); |
22ec19f3 | 992 | |
9d45921e IS |
993 | list_for_each_entry_continue_reverse(vlan, &vg->vlan_list, vlist) { |
994 | if (vlan->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV) | |
995 | continue; | |
2594e906 | 996 | vlan_vid_del(p->dev, proto, vlan->vid); |
9d45921e | 997 | } |
204177f3 | 998 | |
907b1e6e NA |
999 | list_for_each_entry_continue_reverse(p, &br->port_list, list) { |
1000 | vg = nbp_vlan_group(p); | |
9d45921e IS |
1001 | list_for_each_entry(vlan, &vg->vlan_list, vlist) { |
1002 | if (vlan->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV) | |
1003 | continue; | |
2594e906 | 1004 | vlan_vid_del(p->dev, proto, vlan->vid); |
9d45921e | 1005 | } |
907b1e6e | 1006 | } |
204177f3 | 1007 | |
d2d427b3 TM |
1008 | return err; |
1009 | } | |
1010 | ||
9e781401 VO |
1011 | int br_vlan_set_proto(struct net_bridge *br, unsigned long val, |
1012 | struct netlink_ext_ack *extack) | |
d2d427b3 | 1013 | { |
a98c0c47 | 1014 | if (!eth_type_vlan(htons(val))) |
d2d427b3 TM |
1015 | return -EPROTONOSUPPORT; |
1016 | ||
dcbdf135 | 1017 | return __br_vlan_set_proto(br, htons(val), extack); |
204177f3 TM |
1018 | } |
1019 | ||
6dada9b1 NA |
1020 | int br_vlan_set_stats(struct net_bridge *br, unsigned long val) |
1021 | { | |
1022 | switch (val) { | |
1023 | case 0: | |
1024 | case 1: | |
ae75767e | 1025 | br_opt_toggle(br, BROPT_VLAN_STATS_ENABLED, !!val); |
6dada9b1 NA |
1026 | break; |
1027 | default: | |
9163a0fc NA |
1028 | return -EINVAL; |
1029 | } | |
1030 | ||
1031 | return 0; | |
1032 | } | |
1033 | ||
1034 | int br_vlan_set_stats_per_port(struct net_bridge *br, unsigned long val) | |
1035 | { | |
1036 | struct net_bridge_port *p; | |
1037 | ||
1038 | /* allow to change the option if there are no port vlans configured */ | |
1039 | list_for_each_entry(p, &br->port_list, list) { | |
1040 | struct net_bridge_vlan_group *vg = nbp_vlan_group(p); | |
1041 | ||
1042 | if (vg->num_vlans) | |
1043 | return -EBUSY; | |
1044 | } | |
1045 | ||
1046 | switch (val) { | |
1047 | case 0: | |
1048 | case 1: | |
1049 | br_opt_toggle(br, BROPT_VLAN_STATS_PER_PORT, !!val); | |
1050 | break; | |
1051 | default: | |
6dada9b1 NA |
1052 | return -EINVAL; |
1053 | } | |
1054 | ||
1055 | return 0; | |
1056 | } | |
1057 | ||
77751ee8 | 1058 | static bool vlan_default_pvid(struct net_bridge_vlan_group *vg, u16 vid) |
5be5a2df | 1059 | { |
2594e906 NA |
1060 | struct net_bridge_vlan *v; |
1061 | ||
77751ee8 | 1062 | if (vid != vg->pvid) |
2594e906 NA |
1063 | return false; |
1064 | ||
1065 | v = br_vlan_lookup(&vg->vlan_hash, vid); | |
1066 | if (v && br_vlan_should_use(v) && | |
1067 | (v->flags & BRIDGE_VLAN_INFO_UNTAGGED)) | |
1068 | return true; | |
1069 | ||
1070 | return false; | |
5be5a2df VY |
1071 | } |
1072 | ||
1073 | static void br_vlan_disable_default_pvid(struct net_bridge *br) | |
1074 | { | |
1075 | struct net_bridge_port *p; | |
1076 | u16 pvid = br->default_pvid; | |
1077 | ||
1078 | /* Disable default_pvid on all ports where it is still | |
1079 | * configured. | |
1080 | */ | |
f545923b NA |
1081 | if (vlan_default_pvid(br_vlan_group(br), pvid)) { |
1082 | if (!br_vlan_delete(br, pvid)) | |
1083 | br_vlan_notify(br, NULL, pvid, 0, RTM_DELVLAN); | |
1084 | } | |
5be5a2df VY |
1085 | |
1086 | list_for_each_entry(p, &br->port_list, list) { | |
f545923b NA |
1087 | if (vlan_default_pvid(nbp_vlan_group(p), pvid) && |
1088 | !nbp_vlan_delete(p, pvid)) | |
1089 | br_vlan_notify(br, p, pvid, 0, RTM_DELVLAN); | |
5be5a2df VY |
1090 | } |
1091 | ||
1092 | br->default_pvid = 0; | |
1093 | } | |
1094 | ||
169327d5 PM |
1095 | int __br_vlan_set_default_pvid(struct net_bridge *br, u16 pvid, |
1096 | struct netlink_ext_ack *extack) | |
5be5a2df | 1097 | { |
2594e906 | 1098 | const struct net_bridge_vlan *pvent; |
907b1e6e | 1099 | struct net_bridge_vlan_group *vg; |
5be5a2df | 1100 | struct net_bridge_port *p; |
f418af63 NA |
1101 | unsigned long *changed; |
1102 | bool vlchange; | |
5be5a2df VY |
1103 | u16 old_pvid; |
1104 | int err = 0; | |
5be5a2df | 1105 | |
0f963b75 NA |
1106 | if (!pvid) { |
1107 | br_vlan_disable_default_pvid(br); | |
1108 | return 0; | |
1109 | } | |
1110 | ||
459479da | 1111 | changed = bitmap_zalloc(BR_MAX_PORTS, GFP_KERNEL); |
5be5a2df VY |
1112 | if (!changed) |
1113 | return -ENOMEM; | |
1114 | ||
1115 | old_pvid = br->default_pvid; | |
1116 | ||
1117 | /* Update default_pvid config only if we do not conflict with | |
1118 | * user configuration. | |
1119 | */ | |
907b1e6e NA |
1120 | vg = br_vlan_group(br); |
1121 | pvent = br_vlan_find(vg, pvid); | |
1122 | if ((!old_pvid || vlan_default_pvid(vg, old_pvid)) && | |
2594e906 | 1123 | (!pvent || !br_vlan_should_use(pvent))) { |
5be5a2df VY |
1124 | err = br_vlan_add(br, pvid, |
1125 | BRIDGE_VLAN_INFO_PVID | | |
2594e906 | 1126 | BRIDGE_VLAN_INFO_UNTAGGED | |
f418af63 | 1127 | BRIDGE_VLAN_INFO_BRENTRY, |
169327d5 | 1128 | &vlchange, extack); |
5be5a2df VY |
1129 | if (err) |
1130 | goto out; | |
f545923b NA |
1131 | |
1132 | if (br_vlan_delete(br, old_pvid)) | |
1133 | br_vlan_notify(br, NULL, old_pvid, 0, RTM_DELVLAN); | |
1134 | br_vlan_notify(br, NULL, pvid, 0, RTM_NEWVLAN); | |
442b03c3 | 1135 | __set_bit(0, changed); |
5be5a2df VY |
1136 | } |
1137 | ||
1138 | list_for_each_entry(p, &br->port_list, list) { | |
1139 | /* Update default_pvid config only if we do not conflict with | |
1140 | * user configuration. | |
1141 | */ | |
907b1e6e | 1142 | vg = nbp_vlan_group(p); |
5be5a2df | 1143 | if ((old_pvid && |
907b1e6e NA |
1144 | !vlan_default_pvid(vg, old_pvid)) || |
1145 | br_vlan_find(vg, pvid)) | |
5be5a2df VY |
1146 | continue; |
1147 | ||
1148 | err = nbp_vlan_add(p, pvid, | |
1149 | BRIDGE_VLAN_INFO_PVID | | |
f418af63 | 1150 | BRIDGE_VLAN_INFO_UNTAGGED, |
169327d5 | 1151 | &vlchange, extack); |
5be5a2df VY |
1152 | if (err) |
1153 | goto err_port; | |
f545923b NA |
1154 | if (nbp_vlan_delete(p, old_pvid)) |
1155 | br_vlan_notify(br, p, old_pvid, 0, RTM_DELVLAN); | |
1156 | br_vlan_notify(p->br, p, pvid, 0, RTM_NEWVLAN); | |
442b03c3 | 1157 | __set_bit(p->port_no, changed); |
5be5a2df VY |
1158 | } |
1159 | ||
1160 | br->default_pvid = pvid; | |
1161 | ||
1162 | out: | |
459479da | 1163 | bitmap_free(changed); |
5be5a2df VY |
1164 | return err; |
1165 | ||
1166 | err_port: | |
1167 | list_for_each_entry_continue_reverse(p, &br->port_list, list) { | |
1168 | if (!test_bit(p->port_no, changed)) | |
1169 | continue; | |
1170 | ||
f545923b | 1171 | if (old_pvid) { |
5be5a2df VY |
1172 | nbp_vlan_add(p, old_pvid, |
1173 | BRIDGE_VLAN_INFO_PVID | | |
f418af63 | 1174 | BRIDGE_VLAN_INFO_UNTAGGED, |
169327d5 | 1175 | &vlchange, NULL); |
f545923b NA |
1176 | br_vlan_notify(p->br, p, old_pvid, 0, RTM_NEWVLAN); |
1177 | } | |
5be5a2df | 1178 | nbp_vlan_delete(p, pvid); |
f545923b | 1179 | br_vlan_notify(br, p, pvid, 0, RTM_DELVLAN); |
5be5a2df VY |
1180 | } |
1181 | ||
1182 | if (test_bit(0, changed)) { | |
f545923b | 1183 | if (old_pvid) { |
5be5a2df VY |
1184 | br_vlan_add(br, old_pvid, |
1185 | BRIDGE_VLAN_INFO_PVID | | |
2594e906 | 1186 | BRIDGE_VLAN_INFO_UNTAGGED | |
f418af63 | 1187 | BRIDGE_VLAN_INFO_BRENTRY, |
169327d5 | 1188 | &vlchange, NULL); |
f545923b NA |
1189 | br_vlan_notify(br, NULL, old_pvid, 0, RTM_NEWVLAN); |
1190 | } | |
5be5a2df | 1191 | br_vlan_delete(br, pvid); |
f545923b | 1192 | br_vlan_notify(br, NULL, pvid, 0, RTM_DELVLAN); |
5be5a2df VY |
1193 | } |
1194 | goto out; | |
1195 | } | |
1196 | ||
9e781401 VO |
1197 | int br_vlan_set_default_pvid(struct net_bridge *br, unsigned long val, |
1198 | struct netlink_ext_ack *extack) | |
96a20d9d VY |
1199 | { |
1200 | u16 pvid = val; | |
1201 | int err = 0; | |
1202 | ||
5be5a2df | 1203 | if (val >= VLAN_VID_MASK) |
96a20d9d VY |
1204 | return -EINVAL; |
1205 | ||
96a20d9d | 1206 | if (pvid == br->default_pvid) |
047831a9 | 1207 | goto out; |
96a20d9d VY |
1208 | |
1209 | /* Only allow default pvid change when filtering is disabled */ | |
ae75767e | 1210 | if (br_opt_get(br, BROPT_VLAN_ENABLED)) { |
96a20d9d VY |
1211 | pr_info_once("Please disable vlan filtering to change default_pvid\n"); |
1212 | err = -EPERM; | |
047831a9 | 1213 | goto out; |
96a20d9d | 1214 | } |
9e781401 | 1215 | err = __br_vlan_set_default_pvid(br, pvid, extack); |
047831a9 | 1216 | out: |
96a20d9d VY |
1217 | return err; |
1218 | } | |
1219 | ||
5be5a2df | 1220 | int br_vlan_init(struct net_bridge *br) |
8580e211 | 1221 | { |
907b1e6e | 1222 | struct net_bridge_vlan_group *vg; |
2594e906 NA |
1223 | int ret = -ENOMEM; |
1224 | ||
907b1e6e NA |
1225 | vg = kzalloc(sizeof(*vg), GFP_KERNEL); |
1226 | if (!vg) | |
2594e906 | 1227 | goto out; |
907b1e6e | 1228 | ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); |
2594e906 NA |
1229 | if (ret) |
1230 | goto err_rhtbl; | |
efa5356b RP |
1231 | ret = vlan_tunnel_init(vg); |
1232 | if (ret) | |
1233 | goto err_tunnel_init; | |
907b1e6e | 1234 | INIT_LIST_HEAD(&vg->vlan_list); |
8580e211 | 1235 | br->vlan_proto = htons(ETH_P_8021Q); |
96a20d9d | 1236 | br->default_pvid = 1; |
907b1e6e | 1237 | rcu_assign_pointer(br->vlgrp, vg); |
2594e906 NA |
1238 | |
1239 | out: | |
1240 | return ret; | |
1241 | ||
efa5356b | 1242 | err_tunnel_init: |
907b1e6e | 1243 | rhashtable_destroy(&vg->vlan_hash); |
2594e906 | 1244 | err_rhtbl: |
907b1e6e | 1245 | kfree(vg); |
2594e906 NA |
1246 | |
1247 | goto out; | |
1248 | } | |
1249 | ||
169327d5 | 1250 | int nbp_vlan_init(struct net_bridge_port *p, struct netlink_ext_ack *extack) |
2594e906 | 1251 | { |
404cdbf0 ER |
1252 | struct switchdev_attr attr = { |
1253 | .orig_dev = p->br->dev, | |
1254 | .id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING, | |
1255 | .flags = SWITCHDEV_F_SKIP_EOPNOTSUPP, | |
ae75767e | 1256 | .u.vlan_filtering = br_opt_get(p->br, BROPT_VLAN_ENABLED), |
404cdbf0 | 1257 | }; |
263344e6 | 1258 | struct net_bridge_vlan_group *vg; |
2594e906 NA |
1259 | int ret = -ENOMEM; |
1260 | ||
263344e6 NA |
1261 | vg = kzalloc(sizeof(struct net_bridge_vlan_group), GFP_KERNEL); |
1262 | if (!vg) | |
2594e906 NA |
1263 | goto out; |
1264 | ||
dcbdf135 | 1265 | ret = switchdev_port_attr_set(p->dev, &attr, extack); |
404cdbf0 ER |
1266 | if (ret && ret != -EOPNOTSUPP) |
1267 | goto err_vlan_enabled; | |
1268 | ||
263344e6 | 1269 | ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params); |
2594e906 NA |
1270 | if (ret) |
1271 | goto err_rhtbl; | |
efa5356b RP |
1272 | ret = vlan_tunnel_init(vg); |
1273 | if (ret) | |
1274 | goto err_tunnel_init; | |
263344e6 | 1275 | INIT_LIST_HEAD(&vg->vlan_list); |
907b1e6e | 1276 | rcu_assign_pointer(p->vlgrp, vg); |
2594e906 | 1277 | if (p->br->default_pvid) { |
f418af63 NA |
1278 | bool changed; |
1279 | ||
2594e906 NA |
1280 | ret = nbp_vlan_add(p, p->br->default_pvid, |
1281 | BRIDGE_VLAN_INFO_PVID | | |
f418af63 | 1282 | BRIDGE_VLAN_INFO_UNTAGGED, |
169327d5 | 1283 | &changed, extack); |
2594e906 NA |
1284 | if (ret) |
1285 | goto err_vlan_add; | |
f545923b | 1286 | br_vlan_notify(p->br, p, p->br->default_pvid, 0, RTM_NEWVLAN); |
2594e906 NA |
1287 | } |
1288 | out: | |
1289 | return ret; | |
1290 | ||
1291 | err_vlan_add: | |
07bc588f IS |
1292 | RCU_INIT_POINTER(p->vlgrp, NULL); |
1293 | synchronize_rcu(); | |
efa5356b | 1294 | vlan_tunnel_deinit(vg); |
efa5356b RP |
1295 | err_tunnel_init: |
1296 | rhashtable_destroy(&vg->vlan_hash); | |
2594e906 | 1297 | err_rhtbl: |
df2c4334 | 1298 | err_vlan_enabled: |
263344e6 | 1299 | kfree(vg); |
2594e906 NA |
1300 | |
1301 | goto out; | |
8580e211 TM |
1302 | } |
1303 | ||
8adff41c TM |
1304 | /* Must be protected by RTNL. |
1305 | * Must be called with vid in range from 1 to 4094 inclusive. | |
f418af63 | 1306 | * changed must be true only if the vlan was created or updated |
8adff41c | 1307 | */ |
f418af63 | 1308 | int nbp_vlan_add(struct net_bridge_port *port, u16 vid, u16 flags, |
169327d5 | 1309 | bool *changed, struct netlink_ext_ack *extack) |
243a2e63 | 1310 | { |
2594e906 NA |
1311 | struct net_bridge_vlan *vlan; |
1312 | int ret; | |
243a2e63 VY |
1313 | |
1314 | ASSERT_RTNL(); | |
1315 | ||
f418af63 | 1316 | *changed = false; |
907b1e6e | 1317 | vlan = br_vlan_find(nbp_vlan_group(port), vid); |
2594e906 | 1318 | if (vlan) { |
27c5f74c VO |
1319 | bool would_change = __vlan_flags_would_change(vlan, flags); |
1320 | ||
1321 | if (would_change) { | |
1322 | /* Pass the flags to the hardware bridge */ | |
8d23a54f VO |
1323 | ret = br_switchdev_port_vlan_add(port->dev, vid, flags, |
1324 | true, extack); | |
27c5f74c VO |
1325 | if (ret && ret != -EOPNOTSUPP) |
1326 | return ret; | |
1327 | } | |
1328 | ||
1329 | __vlan_flags_commit(vlan, flags); | |
1330 | *changed = would_change; | |
f418af63 | 1331 | |
2594e906 | 1332 | return 0; |
243a2e63 VY |
1333 | } |
1334 | ||
2594e906 NA |
1335 | vlan = kzalloc(sizeof(*vlan), GFP_KERNEL); |
1336 | if (!vlan) | |
1337 | return -ENOMEM; | |
243a2e63 | 1338 | |
2594e906 NA |
1339 | vlan->vid = vid; |
1340 | vlan->port = port; | |
169327d5 | 1341 | ret = __vlan_add(vlan, flags, extack); |
2594e906 NA |
1342 | if (ret) |
1343 | kfree(vlan); | |
f418af63 NA |
1344 | else |
1345 | *changed = true; | |
243a2e63 | 1346 | |
2594e906 | 1347 | return ret; |
243a2e63 VY |
1348 | } |
1349 | ||
8adff41c TM |
1350 | /* Must be protected by RTNL. |
1351 | * Must be called with vid in range from 1 to 4094 inclusive. | |
1352 | */ | |
243a2e63 VY |
1353 | int nbp_vlan_delete(struct net_bridge_port *port, u16 vid) |
1354 | { | |
2594e906 | 1355 | struct net_bridge_vlan *v; |
243a2e63 VY |
1356 | |
1357 | ASSERT_RTNL(); | |
1358 | ||
907b1e6e | 1359 | v = br_vlan_find(nbp_vlan_group(port), vid); |
2594e906 NA |
1360 | if (!v) |
1361 | return -ENOENT; | |
424bb9c9 | 1362 | br_fdb_find_delete_local(port->br, port, port->dev->dev_addr, vid); |
1ea2d020 | 1363 | br_fdb_delete_by_port(port->br, port, vid, 0); |
bc9a25d2 | 1364 | |
2594e906 | 1365 | return __vlan_del(v); |
243a2e63 VY |
1366 | } |
1367 | ||
1368 | void nbp_vlan_flush(struct net_bridge_port *port) | |
1369 | { | |
f409d0ed NA |
1370 | struct net_bridge_vlan_group *vg; |
1371 | ||
243a2e63 VY |
1372 | ASSERT_RTNL(); |
1373 | ||
f409d0ed | 1374 | vg = nbp_vlan_group(port); |
f545923b | 1375 | __vlan_flush(port->br, port, vg); |
f409d0ed | 1376 | RCU_INIT_POINTER(port->vlgrp, NULL); |
48ebf6eb | 1377 | synchronize_net(); |
f409d0ed | 1378 | __vlan_group_free(vg); |
5be5a2df | 1379 | } |
a60c0903 NA |
1380 | |
1381 | void br_vlan_get_stats(const struct net_bridge_vlan *v, | |
281cc284 | 1382 | struct pcpu_sw_netstats *stats) |
a60c0903 NA |
1383 | { |
1384 | int i; | |
1385 | ||
1386 | memset(stats, 0, sizeof(*stats)); | |
1387 | for_each_possible_cpu(i) { | |
1388 | u64 rxpackets, rxbytes, txpackets, txbytes; | |
281cc284 | 1389 | struct pcpu_sw_netstats *cpu_stats; |
a60c0903 NA |
1390 | unsigned int start; |
1391 | ||
1392 | cpu_stats = per_cpu_ptr(v->stats, i); | |
1393 | do { | |
d120d1a6 | 1394 | start = u64_stats_fetch_begin(&cpu_stats->syncp); |
9962acef ED |
1395 | rxpackets = u64_stats_read(&cpu_stats->rx_packets); |
1396 | rxbytes = u64_stats_read(&cpu_stats->rx_bytes); | |
1397 | txbytes = u64_stats_read(&cpu_stats->tx_bytes); | |
1398 | txpackets = u64_stats_read(&cpu_stats->tx_packets); | |
d120d1a6 | 1399 | } while (u64_stats_fetch_retry(&cpu_stats->syncp, start)); |
a60c0903 | 1400 | |
9962acef ED |
1401 | u64_stats_add(&stats->rx_packets, rxpackets); |
1402 | u64_stats_add(&stats->rx_bytes, rxbytes); | |
1403 | u64_stats_add(&stats->tx_bytes, txbytes); | |
1404 | u64_stats_add(&stats->tx_packets, txpackets); | |
a60c0903 NA |
1405 | } |
1406 | } | |
4d4fd361 | 1407 | |
99f62a74 | 1408 | int br_vlan_get_pvid(const struct net_device *dev, u16 *p_pvid) |
4d4fd361 PM |
1409 | { |
1410 | struct net_bridge_vlan_group *vg; | |
99f62a74 | 1411 | struct net_bridge_port *p; |
4d4fd361 | 1412 | |
99f62a74 VO |
1413 | ASSERT_RTNL(); |
1414 | p = br_port_get_check_rtnl(dev); | |
5a6db04c IS |
1415 | if (p) |
1416 | vg = nbp_vlan_group(p); | |
1417 | else if (netif_is_bridge_master(dev)) | |
4d4fd361 PM |
1418 | vg = br_vlan_group(netdev_priv(dev)); |
1419 | else | |
1420 | return -EINVAL; | |
1421 | ||
1422 | *p_pvid = br_get_pvid(vg); | |
1423 | return 0; | |
1424 | } | |
1425 | EXPORT_SYMBOL_GPL(br_vlan_get_pvid); | |
1426 | ||
7582f5b7 PNA |
1427 | int br_vlan_get_pvid_rcu(const struct net_device *dev, u16 *p_pvid) |
1428 | { | |
99f62a74 VO |
1429 | struct net_bridge_vlan_group *vg; |
1430 | struct net_bridge_port *p; | |
1431 | ||
1432 | p = br_port_get_check_rcu(dev); | |
1433 | if (p) | |
1434 | vg = nbp_vlan_group_rcu(p); | |
1435 | else if (netif_is_bridge_master(dev)) | |
1436 | vg = br_vlan_group_rcu(netdev_priv(dev)); | |
1437 | else | |
1438 | return -EINVAL; | |
1439 | ||
1440 | *p_pvid = br_get_pvid(vg); | |
1441 | return 0; | |
7582f5b7 PNA |
1442 | } |
1443 | EXPORT_SYMBOL_GPL(br_vlan_get_pvid_rcu); | |
1444 | ||
bcf2766b FF |
1445 | void br_vlan_fill_forward_path_pvid(struct net_bridge *br, |
1446 | struct net_device_path_ctx *ctx, | |
1447 | struct net_device_path *path) | |
1448 | { | |
1449 | struct net_bridge_vlan_group *vg; | |
1450 | int idx = ctx->num_vlans - 1; | |
1451 | u16 vid; | |
1452 | ||
1453 | path->bridge.vlan_mode = DEV_PATH_BR_VLAN_KEEP; | |
1454 | ||
1455 | if (!br_opt_get(br, BROPT_VLAN_ENABLED)) | |
1456 | return; | |
1457 | ||
1458 | vg = br_vlan_group(br); | |
1459 | ||
1460 | if (idx >= 0 && | |
1461 | ctx->vlan[idx].proto == br->vlan_proto) { | |
1462 | vid = ctx->vlan[idx].id; | |
1463 | } else { | |
1464 | path->bridge.vlan_mode = DEV_PATH_BR_VLAN_TAG; | |
1465 | vid = br_get_pvid(vg); | |
1466 | } | |
1467 | ||
1468 | path->bridge.vlan_id = vid; | |
1469 | path->bridge.vlan_proto = br->vlan_proto; | |
1470 | } | |
1471 | ||
1472 | int br_vlan_fill_forward_path_mode(struct net_bridge *br, | |
1473 | struct net_bridge_port *dst, | |
1474 | struct net_device_path *path) | |
1475 | { | |
1476 | struct net_bridge_vlan_group *vg; | |
1477 | struct net_bridge_vlan *v; | |
1478 | ||
1479 | if (!br_opt_get(br, BROPT_VLAN_ENABLED)) | |
1480 | return 0; | |
1481 | ||
1482 | vg = nbp_vlan_group_rcu(dst); | |
1483 | v = br_vlan_find(vg, path->bridge.vlan_id); | |
1484 | if (!v || !br_vlan_should_use(v)) | |
1485 | return -EINVAL; | |
1486 | ||
1487 | if (!(v->flags & BRIDGE_VLAN_INFO_UNTAGGED)) | |
1488 | return 0; | |
1489 | ||
1490 | if (path->bridge.vlan_mode == DEV_PATH_BR_VLAN_TAG) | |
1491 | path->bridge.vlan_mode = DEV_PATH_BR_VLAN_KEEP; | |
26267bf9 FF |
1492 | else if (v->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV) |
1493 | path->bridge.vlan_mode = DEV_PATH_BR_VLAN_UNTAG_HW; | |
bcf2766b FF |
1494 | else |
1495 | path->bridge.vlan_mode = DEV_PATH_BR_VLAN_UNTAG; | |
1496 | ||
1497 | return 0; | |
1498 | } | |
1499 | ||
4d4fd361 PM |
1500 | int br_vlan_get_info(const struct net_device *dev, u16 vid, |
1501 | struct bridge_vlan_info *p_vinfo) | |
1502 | { | |
1503 | struct net_bridge_vlan_group *vg; | |
1504 | struct net_bridge_vlan *v; | |
1505 | struct net_bridge_port *p; | |
1506 | ||
1507 | ASSERT_RTNL(); | |
1508 | p = br_port_get_check_rtnl(dev); | |
1509 | if (p) | |
1510 | vg = nbp_vlan_group(p); | |
2b18d79e PM |
1511 | else if (netif_is_bridge_master(dev)) |
1512 | vg = br_vlan_group(netdev_priv(dev)); | |
4d4fd361 PM |
1513 | else |
1514 | return -EINVAL; | |
1515 | ||
1516 | v = br_vlan_find(vg, vid); | |
1517 | if (!v) | |
1518 | return -ENOENT; | |
1519 | ||
1520 | p_vinfo->vid = vid; | |
1521 | p_vinfo->flags = v->flags; | |
f40d9b20 VO |
1522 | if (vid == br_get_pvid(vg)) |
1523 | p_vinfo->flags |= BRIDGE_VLAN_INFO_PVID; | |
4d4fd361 PM |
1524 | return 0; |
1525 | } | |
1526 | EXPORT_SYMBOL_GPL(br_vlan_get_info); | |
9c0ec2e7 | 1527 | |
ee80dd2e VO |
1528 | int br_vlan_get_info_rcu(const struct net_device *dev, u16 vid, |
1529 | struct bridge_vlan_info *p_vinfo) | |
1530 | { | |
1531 | struct net_bridge_vlan_group *vg; | |
1532 | struct net_bridge_vlan *v; | |
1533 | struct net_bridge_port *p; | |
1534 | ||
1535 | p = br_port_get_check_rcu(dev); | |
1536 | if (p) | |
1537 | vg = nbp_vlan_group_rcu(p); | |
1538 | else if (netif_is_bridge_master(dev)) | |
1539 | vg = br_vlan_group_rcu(netdev_priv(dev)); | |
1540 | else | |
1541 | return -EINVAL; | |
1542 | ||
1543 | v = br_vlan_find(vg, vid); | |
1544 | if (!v) | |
1545 | return -ENOENT; | |
1546 | ||
1547 | p_vinfo->vid = vid; | |
1548 | p_vinfo->flags = v->flags; | |
1549 | if (vid == br_get_pvid(vg)) | |
1550 | p_vinfo->flags |= BRIDGE_VLAN_INFO_PVID; | |
1551 | return 0; | |
1552 | } | |
1553 | EXPORT_SYMBOL_GPL(br_vlan_get_info_rcu); | |
1554 | ||
9c0ec2e7 MM |
1555 | static int br_vlan_is_bind_vlan_dev(const struct net_device *dev) |
1556 | { | |
1557 | return is_vlan_dev(dev) && | |
1558 | !!(vlan_dev_priv(dev)->flags & VLAN_FLAG_BRIDGE_BINDING); | |
1559 | } | |
1560 | ||
1561 | static int br_vlan_is_bind_vlan_dev_fn(struct net_device *dev, | |
eff74233 | 1562 | __always_unused struct netdev_nested_priv *priv) |
9c0ec2e7 MM |
1563 | { |
1564 | return br_vlan_is_bind_vlan_dev(dev); | |
1565 | } | |
1566 | ||
1567 | static bool br_vlan_has_upper_bind_vlan_dev(struct net_device *dev) | |
1568 | { | |
1569 | int found; | |
1570 | ||
1571 | rcu_read_lock(); | |
1572 | found = netdev_walk_all_upper_dev_rcu(dev, br_vlan_is_bind_vlan_dev_fn, | |
1573 | NULL); | |
1574 | rcu_read_unlock(); | |
1575 | ||
1576 | return !!found; | |
1577 | } | |
1578 | ||
1579 | struct br_vlan_bind_walk_data { | |
1580 | u16 vid; | |
1581 | struct net_device *result; | |
1582 | }; | |
1583 | ||
1584 | static int br_vlan_match_bind_vlan_dev_fn(struct net_device *dev, | |
eff74233 | 1585 | struct netdev_nested_priv *priv) |
9c0ec2e7 | 1586 | { |
eff74233 | 1587 | struct br_vlan_bind_walk_data *data = priv->data; |
9c0ec2e7 MM |
1588 | int found = 0; |
1589 | ||
1590 | if (br_vlan_is_bind_vlan_dev(dev) && | |
1591 | vlan_dev_priv(dev)->vlan_id == data->vid) { | |
1592 | data->result = dev; | |
1593 | found = 1; | |
1594 | } | |
1595 | ||
1596 | return found; | |
1597 | } | |
1598 | ||
1599 | static struct net_device * | |
1600 | br_vlan_get_upper_bind_vlan_dev(struct net_device *dev, u16 vid) | |
1601 | { | |
1602 | struct br_vlan_bind_walk_data data = { | |
1603 | .vid = vid, | |
1604 | }; | |
eff74233 TY |
1605 | struct netdev_nested_priv priv = { |
1606 | .data = (void *)&data, | |
1607 | }; | |
9c0ec2e7 MM |
1608 | |
1609 | rcu_read_lock(); | |
1610 | netdev_walk_all_upper_dev_rcu(dev, br_vlan_match_bind_vlan_dev_fn, | |
eff74233 | 1611 | &priv); |
9c0ec2e7 MM |
1612 | rcu_read_unlock(); |
1613 | ||
1614 | return data.result; | |
1615 | } | |
1616 | ||
1617 | static bool br_vlan_is_dev_up(const struct net_device *dev) | |
1618 | { | |
1619 | return !!(dev->flags & IFF_UP) && netif_oper_up(dev); | |
1620 | } | |
1621 | ||
1622 | static void br_vlan_set_vlan_dev_state(const struct net_bridge *br, | |
1623 | struct net_device *vlan_dev) | |
1624 | { | |
1625 | u16 vid = vlan_dev_priv(vlan_dev)->vlan_id; | |
1626 | struct net_bridge_vlan_group *vg; | |
1627 | struct net_bridge_port *p; | |
1628 | bool has_carrier = false; | |
1629 | ||
8e1acd4f MM |
1630 | if (!netif_carrier_ok(br->dev)) { |
1631 | netif_carrier_off(vlan_dev); | |
1632 | return; | |
1633 | } | |
1634 | ||
9c0ec2e7 MM |
1635 | list_for_each_entry(p, &br->port_list, list) { |
1636 | vg = nbp_vlan_group(p); | |
1637 | if (br_vlan_find(vg, vid) && br_vlan_is_dev_up(p->dev)) { | |
1638 | has_carrier = true; | |
1639 | break; | |
1640 | } | |
1641 | } | |
1642 | ||
1643 | if (has_carrier) | |
1644 | netif_carrier_on(vlan_dev); | |
1645 | else | |
1646 | netif_carrier_off(vlan_dev); | |
1647 | } | |
1648 | ||
1649 | static void br_vlan_set_all_vlan_dev_state(struct net_bridge_port *p) | |
1650 | { | |
1651 | struct net_bridge_vlan_group *vg = nbp_vlan_group(p); | |
1652 | struct net_bridge_vlan *vlan; | |
1653 | struct net_device *vlan_dev; | |
1654 | ||
1655 | list_for_each_entry(vlan, &vg->vlan_list, vlist) { | |
1656 | vlan_dev = br_vlan_get_upper_bind_vlan_dev(p->br->dev, | |
1657 | vlan->vid); | |
1658 | if (vlan_dev) { | |
8e1acd4f MM |
1659 | if (br_vlan_is_dev_up(p->dev)) { |
1660 | if (netif_carrier_ok(p->br->dev)) | |
1661 | netif_carrier_on(vlan_dev); | |
1662 | } else { | |
9c0ec2e7 | 1663 | br_vlan_set_vlan_dev_state(p->br, vlan_dev); |
8e1acd4f | 1664 | } |
9c0ec2e7 MM |
1665 | } |
1666 | } | |
1667 | } | |
1668 | ||
f284424d PM |
1669 | static void br_vlan_toggle_bridge_binding(struct net_device *br_dev, |
1670 | bool enable) | |
1671 | { | |
1672 | struct net_bridge *br = netdev_priv(br_dev); | |
1673 | ||
1674 | if (enable) | |
1675 | br_opt_toggle(br, BROPT_VLAN_BRIDGE_BINDING, true); | |
1676 | else | |
1677 | br_opt_toggle(br, BROPT_VLAN_BRIDGE_BINDING, | |
1678 | br_vlan_has_upper_bind_vlan_dev(br_dev)); | |
1679 | } | |
1680 | ||
9c0ec2e7 MM |
1681 | static void br_vlan_upper_change(struct net_device *dev, |
1682 | struct net_device *upper_dev, | |
1683 | bool linking) | |
1684 | { | |
1685 | struct net_bridge *br = netdev_priv(dev); | |
1686 | ||
1687 | if (!br_vlan_is_bind_vlan_dev(upper_dev)) | |
1688 | return; | |
1689 | ||
f284424d PM |
1690 | br_vlan_toggle_bridge_binding(dev, linking); |
1691 | if (linking) | |
9c0ec2e7 | 1692 | br_vlan_set_vlan_dev_state(br, upper_dev); |
9c0ec2e7 MM |
1693 | } |
1694 | ||
8e1acd4f MM |
1695 | struct br_vlan_link_state_walk_data { |
1696 | struct net_bridge *br; | |
1697 | }; | |
1698 | ||
1699 | static int br_vlan_link_state_change_fn(struct net_device *vlan_dev, | |
eff74233 | 1700 | struct netdev_nested_priv *priv) |
8e1acd4f | 1701 | { |
eff74233 | 1702 | struct br_vlan_link_state_walk_data *data = priv->data; |
8e1acd4f MM |
1703 | |
1704 | if (br_vlan_is_bind_vlan_dev(vlan_dev)) | |
1705 | br_vlan_set_vlan_dev_state(data->br, vlan_dev); | |
1706 | ||
1707 | return 0; | |
1708 | } | |
1709 | ||
1710 | static void br_vlan_link_state_change(struct net_device *dev, | |
1711 | struct net_bridge *br) | |
1712 | { | |
1713 | struct br_vlan_link_state_walk_data data = { | |
1714 | .br = br | |
1715 | }; | |
eff74233 TY |
1716 | struct netdev_nested_priv priv = { |
1717 | .data = (void *)&data, | |
1718 | }; | |
8e1acd4f MM |
1719 | |
1720 | rcu_read_lock(); | |
1721 | netdev_walk_all_upper_dev_rcu(dev, br_vlan_link_state_change_fn, | |
eff74233 | 1722 | &priv); |
8e1acd4f MM |
1723 | rcu_read_unlock(); |
1724 | } | |
1725 | ||
80900acd MM |
1726 | /* Must be protected by RTNL. */ |
1727 | static void nbp_vlan_set_vlan_dev_state(struct net_bridge_port *p, u16 vid) | |
1728 | { | |
1729 | struct net_device *vlan_dev; | |
1730 | ||
1731 | if (!br_opt_get(p->br, BROPT_VLAN_BRIDGE_BINDING)) | |
1732 | return; | |
1733 | ||
1734 | vlan_dev = br_vlan_get_upper_bind_vlan_dev(p->br->dev, vid); | |
1735 | if (vlan_dev) | |
1736 | br_vlan_set_vlan_dev_state(p->br, vlan_dev); | |
1737 | } | |
1738 | ||
9c0ec2e7 | 1739 | /* Must be protected by RTNL. */ |
091adf9b | 1740 | int br_vlan_bridge_event(struct net_device *dev, unsigned long event, void *ptr) |
9c0ec2e7 MM |
1741 | { |
1742 | struct netdev_notifier_changeupper_info *info; | |
091adf9b | 1743 | struct net_bridge *br = netdev_priv(dev); |
f545923b NA |
1744 | int vlcmd = 0, ret = 0; |
1745 | bool changed = false; | |
9c0ec2e7 MM |
1746 | |
1747 | switch (event) { | |
091adf9b NA |
1748 | case NETDEV_REGISTER: |
1749 | ret = br_vlan_add(br, br->default_pvid, | |
1750 | BRIDGE_VLAN_INFO_PVID | | |
1751 | BRIDGE_VLAN_INFO_UNTAGGED | | |
1752 | BRIDGE_VLAN_INFO_BRENTRY, &changed, NULL); | |
f545923b | 1753 | vlcmd = RTM_NEWVLAN; |
091adf9b NA |
1754 | break; |
1755 | case NETDEV_UNREGISTER: | |
f545923b NA |
1756 | changed = !br_vlan_delete(br, br->default_pvid); |
1757 | vlcmd = RTM_DELVLAN; | |
091adf9b | 1758 | break; |
9c0ec2e7 MM |
1759 | case NETDEV_CHANGEUPPER: |
1760 | info = ptr; | |
1761 | br_vlan_upper_change(dev, info->upper_dev, info->linking); | |
1762 | break; | |
8e1acd4f MM |
1763 | |
1764 | case NETDEV_CHANGE: | |
1765 | case NETDEV_UP: | |
8e1acd4f | 1766 | if (!br_opt_get(br, BROPT_VLAN_BRIDGE_BINDING)) |
091adf9b | 1767 | break; |
8e1acd4f MM |
1768 | br_vlan_link_state_change(dev, br); |
1769 | break; | |
9c0ec2e7 | 1770 | } |
f545923b NA |
1771 | if (changed) |
1772 | br_vlan_notify(br, NULL, br->default_pvid, 0, vlcmd); | |
091adf9b NA |
1773 | |
1774 | return ret; | |
9c0ec2e7 MM |
1775 | } |
1776 | ||
3abd4512 PM |
1777 | void br_vlan_vlan_upper_event(struct net_device *br_dev, |
1778 | struct net_device *vlan_dev, | |
1779 | unsigned long event) | |
1780 | { | |
1781 | struct vlan_dev_priv *vlan = vlan_dev_priv(vlan_dev); | |
1782 | struct net_bridge *br = netdev_priv(br_dev); | |
1783 | bool bridge_binding; | |
1784 | ||
1785 | switch (event) { | |
1786 | case NETDEV_CHANGE: | |
1787 | case NETDEV_UP: | |
1788 | break; | |
1789 | default: | |
1790 | return; | |
1791 | } | |
1792 | ||
1793 | bridge_binding = vlan->flags & VLAN_FLAG_BRIDGE_BINDING; | |
1794 | br_vlan_toggle_bridge_binding(br_dev, bridge_binding); | |
1795 | if (bridge_binding) | |
1796 | br_vlan_set_vlan_dev_state(br, vlan_dev); | |
1797 | else if (!bridge_binding && netif_carrier_ok(br_dev)) | |
1798 | netif_carrier_on(vlan_dev); | |
1799 | } | |
1800 | ||
9c0ec2e7 MM |
1801 | /* Must be protected by RTNL. */ |
1802 | void br_vlan_port_event(struct net_bridge_port *p, unsigned long event) | |
1803 | { | |
1804 | if (!br_opt_get(p->br, BROPT_VLAN_BRIDGE_BINDING)) | |
1805 | return; | |
1806 | ||
1807 | switch (event) { | |
1808 | case NETDEV_CHANGE: | |
1809 | case NETDEV_DOWN: | |
1810 | case NETDEV_UP: | |
1811 | br_vlan_set_all_vlan_dev_state(p); | |
1812 | break; | |
1813 | } | |
1814 | } | |
8dcea187 | 1815 | |
56d09976 NA |
1816 | static bool br_vlan_stats_fill(struct sk_buff *skb, |
1817 | const struct net_bridge_vlan *v) | |
1818 | { | |
281cc284 | 1819 | struct pcpu_sw_netstats stats; |
56d09976 NA |
1820 | struct nlattr *nest; |
1821 | ||
1822 | nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY_STATS); | |
1823 | if (!nest) | |
1824 | return false; | |
1825 | ||
1826 | br_vlan_get_stats(v, &stats); | |
9962acef ED |
1827 | if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_RX_BYTES, |
1828 | u64_stats_read(&stats.rx_bytes), | |
56d09976 NA |
1829 | BRIDGE_VLANDB_STATS_PAD) || |
1830 | nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_RX_PACKETS, | |
9962acef ED |
1831 | u64_stats_read(&stats.rx_packets), |
1832 | BRIDGE_VLANDB_STATS_PAD) || | |
1833 | nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_TX_BYTES, | |
1834 | u64_stats_read(&stats.tx_bytes), | |
56d09976 NA |
1835 | BRIDGE_VLANDB_STATS_PAD) || |
1836 | nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_TX_PACKETS, | |
9962acef ED |
1837 | u64_stats_read(&stats.tx_packets), |
1838 | BRIDGE_VLANDB_STATS_PAD)) | |
56d09976 NA |
1839 | goto out_err; |
1840 | ||
1841 | nla_nest_end(skb, nest); | |
1842 | ||
1843 | return true; | |
1844 | ||
1845 | out_err: | |
1846 | nla_nest_cancel(skb, nest); | |
1847 | return false; | |
1848 | } | |
1849 | ||
7a53e718 | 1850 | /* v_opts is used to dump the options which must be equal in the whole range */ |
0ab55879 | 1851 | static bool br_vlan_fill_vids(struct sk_buff *skb, u16 vid, u16 vid_range, |
7a53e718 | 1852 | const struct net_bridge_vlan *v_opts, |
a1aee20d | 1853 | const struct net_bridge_port *p, |
56d09976 NA |
1854 | u16 flags, |
1855 | bool dump_stats) | |
8dcea187 NA |
1856 | { |
1857 | struct bridge_vlan_info info; | |
1858 | struct nlattr *nest; | |
1859 | ||
1860 | nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY); | |
1861 | if (!nest) | |
1862 | return false; | |
1863 | ||
1864 | memset(&info, 0, sizeof(info)); | |
1865 | info.vid = vid; | |
1866 | if (flags & BRIDGE_VLAN_INFO_UNTAGGED) | |
1867 | info.flags |= BRIDGE_VLAN_INFO_UNTAGGED; | |
1868 | if (flags & BRIDGE_VLAN_INFO_PVID) | |
1869 | info.flags |= BRIDGE_VLAN_INFO_PVID; | |
1870 | ||
1871 | if (nla_put(skb, BRIDGE_VLANDB_ENTRY_INFO, sizeof(info), &info)) | |
1872 | goto out_err; | |
1873 | ||
0ab55879 NA |
1874 | if (vid_range && vid < vid_range && |
1875 | !(flags & BRIDGE_VLAN_INFO_PVID) && | |
1876 | nla_put_u16(skb, BRIDGE_VLANDB_ENTRY_RANGE, vid_range)) | |
1877 | goto out_err; | |
1878 | ||
56d09976 | 1879 | if (v_opts) { |
a1aee20d | 1880 | if (!br_vlan_opts_fill(skb, v_opts, p)) |
56d09976 NA |
1881 | goto out_err; |
1882 | ||
1883 | if (dump_stats && !br_vlan_stats_fill(skb, v_opts)) | |
1884 | goto out_err; | |
1885 | } | |
7a53e718 | 1886 | |
8dcea187 NA |
1887 | nla_nest_end(skb, nest); |
1888 | ||
1889 | return true; | |
1890 | ||
1891 | out_err: | |
1892 | nla_nest_cancel(skb, nest); | |
1893 | return false; | |
1894 | } | |
1895 | ||
cf5bddb9 NA |
1896 | static size_t rtnl_vlan_nlmsg_size(void) |
1897 | { | |
1898 | return NLMSG_ALIGN(sizeof(struct br_vlan_msg)) | |
1899 | + nla_total_size(0) /* BRIDGE_VLANDB_ENTRY */ | |
1900 | + nla_total_size(sizeof(u16)) /* BRIDGE_VLANDB_ENTRY_RANGE */ | |
7a53e718 NA |
1901 | + nla_total_size(sizeof(struct bridge_vlan_info)) /* BRIDGE_VLANDB_ENTRY_INFO */ |
1902 | + br_vlan_opts_nl_size(); /* bridge vlan options */ | |
cf5bddb9 NA |
1903 | } |
1904 | ||
1905 | void br_vlan_notify(const struct net_bridge *br, | |
1906 | const struct net_bridge_port *p, | |
1907 | u16 vid, u16 vid_range, | |
1908 | int cmd) | |
1909 | { | |
1910 | struct net_bridge_vlan_group *vg; | |
7a53e718 | 1911 | struct net_bridge_vlan *v = NULL; |
cf5bddb9 NA |
1912 | struct br_vlan_msg *bvm; |
1913 | struct nlmsghdr *nlh; | |
1914 | struct sk_buff *skb; | |
1915 | int err = -ENOBUFS; | |
1916 | struct net *net; | |
1917 | u16 flags = 0; | |
1918 | int ifindex; | |
1919 | ||
1920 | /* right now notifications are done only with rtnl held */ | |
1921 | ASSERT_RTNL(); | |
1922 | ||
1923 | if (p) { | |
1924 | ifindex = p->dev->ifindex; | |
1925 | vg = nbp_vlan_group(p); | |
1926 | net = dev_net(p->dev); | |
1927 | } else { | |
1928 | ifindex = br->dev->ifindex; | |
1929 | vg = br_vlan_group(br); | |
1930 | net = dev_net(br->dev); | |
1931 | } | |
1932 | ||
1933 | skb = nlmsg_new(rtnl_vlan_nlmsg_size(), GFP_KERNEL); | |
1934 | if (!skb) | |
1935 | goto out_err; | |
1936 | ||
1937 | err = -EMSGSIZE; | |
1938 | nlh = nlmsg_put(skb, 0, 0, cmd, sizeof(*bvm), 0); | |
1939 | if (!nlh) | |
1940 | goto out_err; | |
1941 | bvm = nlmsg_data(nlh); | |
1942 | memset(bvm, 0, sizeof(*bvm)); | |
1943 | bvm->family = AF_BRIDGE; | |
1944 | bvm->ifindex = ifindex; | |
1945 | ||
1946 | switch (cmd) { | |
1947 | case RTM_NEWVLAN: | |
1948 | /* need to find the vlan due to flags/options */ | |
1949 | v = br_vlan_find(vg, vid); | |
1950 | if (!v || !br_vlan_should_use(v)) | |
1951 | goto out_kfree; | |
1952 | ||
1953 | flags = v->flags; | |
1954 | if (br_get_pvid(vg) == v->vid) | |
1955 | flags |= BRIDGE_VLAN_INFO_PVID; | |
1956 | break; | |
1957 | case RTM_DELVLAN: | |
1958 | break; | |
1959 | default: | |
1960 | goto out_kfree; | |
1961 | } | |
1962 | ||
a1aee20d | 1963 | if (!br_vlan_fill_vids(skb, vid, vid_range, v, p, flags, false)) |
cf5bddb9 NA |
1964 | goto out_err; |
1965 | ||
1966 | nlmsg_end(skb, nlh); | |
1967 | rtnl_notify(skb, net, 0, RTNLGRP_BRVLAN, NULL, GFP_KERNEL); | |
1968 | return; | |
1969 | ||
1970 | out_err: | |
1971 | rtnl_set_sk_err(net, RTNLGRP_BRVLAN, err); | |
1972 | out_kfree: | |
1973 | kfree_skb(skb); | |
1974 | } | |
1975 | ||
0ab55879 | 1976 | /* check if v_curr can enter a range ending in range_end */ |
a5d29ae2 NA |
1977 | bool br_vlan_can_enter_range(const struct net_bridge_vlan *v_curr, |
1978 | const struct net_bridge_vlan *range_end) | |
0ab55879 NA |
1979 | { |
1980 | return v_curr->vid - range_end->vid == 1 && | |
7a53e718 | 1981 | range_end->flags == v_curr->flags && |
99f7c5e0 | 1982 | br_vlan_opts_eq_range(v_curr, range_end); |
0ab55879 NA |
1983 | } |
1984 | ||
8dcea187 NA |
1985 | static int br_vlan_dump_dev(const struct net_device *dev, |
1986 | struct sk_buff *skb, | |
56d09976 NA |
1987 | struct netlink_callback *cb, |
1988 | u32 dump_flags) | |
8dcea187 | 1989 | { |
0ab55879 | 1990 | struct net_bridge_vlan *v, *range_start = NULL, *range_end = NULL; |
743a53d9 | 1991 | bool dump_global = !!(dump_flags & BRIDGE_VLANDB_DUMPF_GLOBAL); |
56d09976 | 1992 | bool dump_stats = !!(dump_flags & BRIDGE_VLANDB_DUMPF_STATS); |
8dcea187 NA |
1993 | struct net_bridge_vlan_group *vg; |
1994 | int idx = 0, s_idx = cb->args[1]; | |
1995 | struct nlmsghdr *nlh = NULL; | |
8dcea187 NA |
1996 | struct net_bridge_port *p; |
1997 | struct br_vlan_msg *bvm; | |
1998 | struct net_bridge *br; | |
1999 | int err = 0; | |
2000 | u16 pvid; | |
2001 | ||
2002 | if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev)) | |
2003 | return -EINVAL; | |
2004 | ||
2005 | if (netif_is_bridge_master(dev)) { | |
2006 | br = netdev_priv(dev); | |
2007 | vg = br_vlan_group_rcu(br); | |
2008 | p = NULL; | |
2009 | } else { | |
743a53d9 NA |
2010 | /* global options are dumped only for bridge devices */ |
2011 | if (dump_global) | |
2012 | return 0; | |
2013 | ||
8dcea187 NA |
2014 | p = br_port_get_rcu(dev); |
2015 | if (WARN_ON(!p)) | |
2016 | return -EINVAL; | |
2017 | vg = nbp_vlan_group_rcu(p); | |
2018 | br = p->br; | |
2019 | } | |
2020 | ||
2021 | if (!vg) | |
2022 | return 0; | |
2023 | ||
2024 | nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq, | |
2025 | RTM_NEWVLAN, sizeof(*bvm), NLM_F_MULTI); | |
2026 | if (!nlh) | |
2027 | return -EMSGSIZE; | |
2028 | bvm = nlmsg_data(nlh); | |
2029 | memset(bvm, 0, sizeof(*bvm)); | |
2030 | bvm->family = PF_BRIDGE; | |
2031 | bvm->ifindex = dev->ifindex; | |
2032 | pvid = br_get_pvid(vg); | |
2033 | ||
0ab55879 | 2034 | /* idx must stay at range's beginning until it is filled in */ |
8dcea187 | 2035 | list_for_each_entry_rcu(v, &vg->vlan_list, vlist) { |
743a53d9 | 2036 | if (!dump_global && !br_vlan_should_use(v)) |
8dcea187 | 2037 | continue; |
0ab55879 NA |
2038 | if (idx < s_idx) { |
2039 | idx++; | |
2040 | continue; | |
8dcea187 | 2041 | } |
0ab55879 NA |
2042 | |
2043 | if (!range_start) { | |
2044 | range_start = v; | |
2045 | range_end = v; | |
2046 | continue; | |
2047 | } | |
2048 | ||
743a53d9 NA |
2049 | if (dump_global) { |
2050 | if (br_vlan_global_opts_can_enter_range(v, range_end)) | |
6c4110d9 | 2051 | goto update_end; |
743a53d9 NA |
2052 | if (!br_vlan_global_opts_fill(skb, range_start->vid, |
2053 | range_end->vid, | |
2054 | range_start)) { | |
2055 | err = -EMSGSIZE; | |
2056 | break; | |
2057 | } | |
2058 | /* advance number of filled vlans */ | |
2059 | idx += range_end->vid - range_start->vid + 1; | |
2060 | ||
2061 | range_start = v; | |
2062 | } else if (dump_stats || v->vid == pvid || | |
2063 | !br_vlan_can_enter_range(v, range_end)) { | |
56d09976 | 2064 | u16 vlan_flags = br_vlan_flags(range_start, pvid); |
0ab55879 NA |
2065 | |
2066 | if (!br_vlan_fill_vids(skb, range_start->vid, | |
7a53e718 | 2067 | range_end->vid, range_start, |
a1aee20d | 2068 | p, vlan_flags, dump_stats)) { |
0ab55879 NA |
2069 | err = -EMSGSIZE; |
2070 | break; | |
2071 | } | |
2072 | /* advance number of filled vlans */ | |
2073 | idx += range_end->vid - range_start->vid + 1; | |
2074 | ||
2075 | range_start = v; | |
2076 | } | |
6c4110d9 | 2077 | update_end: |
0ab55879 | 2078 | range_end = v; |
8dcea187 | 2079 | } |
0ab55879 NA |
2080 | |
2081 | /* err will be 0 and range_start will be set in 3 cases here: | |
2082 | * - first vlan (range_start == range_end) | |
2083 | * - last vlan (range_start == range_end, not in range) | |
2084 | * - last vlan range (range_start != range_end, in range) | |
2085 | */ | |
743a53d9 NA |
2086 | if (!err && range_start) { |
2087 | if (dump_global && | |
2088 | !br_vlan_global_opts_fill(skb, range_start->vid, | |
2089 | range_end->vid, range_start)) | |
2090 | err = -EMSGSIZE; | |
2091 | else if (!dump_global && | |
2092 | !br_vlan_fill_vids(skb, range_start->vid, | |
2093 | range_end->vid, range_start, | |
a1aee20d | 2094 | p, br_vlan_flags(range_start, pvid), |
743a53d9 NA |
2095 | dump_stats)) |
2096 | err = -EMSGSIZE; | |
2097 | } | |
0ab55879 NA |
2098 | |
2099 | cb->args[1] = err ? idx : 0; | |
2100 | ||
8dcea187 NA |
2101 | nlmsg_end(skb, nlh); |
2102 | ||
2103 | return err; | |
2104 | } | |
2105 | ||
56d09976 NA |
2106 | static const struct nla_policy br_vlan_db_dump_pol[BRIDGE_VLANDB_DUMP_MAX + 1] = { |
2107 | [BRIDGE_VLANDB_DUMP_FLAGS] = { .type = NLA_U32 }, | |
2108 | }; | |
2109 | ||
8dcea187 NA |
2110 | static int br_vlan_rtm_dump(struct sk_buff *skb, struct netlink_callback *cb) |
2111 | { | |
56d09976 | 2112 | struct nlattr *dtb[BRIDGE_VLANDB_DUMP_MAX + 1]; |
8dcea187 NA |
2113 | int idx = 0, err = 0, s_idx = cb->args[0]; |
2114 | struct net *net = sock_net(skb->sk); | |
2115 | struct br_vlan_msg *bvm; | |
2116 | struct net_device *dev; | |
56d09976 | 2117 | u32 dump_flags = 0; |
8dcea187 | 2118 | |
56d09976 NA |
2119 | err = nlmsg_parse(cb->nlh, sizeof(*bvm), dtb, BRIDGE_VLANDB_DUMP_MAX, |
2120 | br_vlan_db_dump_pol, cb->extack); | |
8dcea187 NA |
2121 | if (err < 0) |
2122 | return err; | |
2123 | ||
2124 | bvm = nlmsg_data(cb->nlh); | |
56d09976 NA |
2125 | if (dtb[BRIDGE_VLANDB_DUMP_FLAGS]) |
2126 | dump_flags = nla_get_u32(dtb[BRIDGE_VLANDB_DUMP_FLAGS]); | |
8dcea187 NA |
2127 | |
2128 | rcu_read_lock(); | |
2129 | if (bvm->ifindex) { | |
2130 | dev = dev_get_by_index_rcu(net, bvm->ifindex); | |
2131 | if (!dev) { | |
2132 | err = -ENODEV; | |
2133 | goto out_err; | |
2134 | } | |
56d09976 | 2135 | err = br_vlan_dump_dev(dev, skb, cb, dump_flags); |
dcb2c5c6 NA |
2136 | /* if the dump completed without an error we return 0 here */ |
2137 | if (err != -EMSGSIZE) | |
8dcea187 NA |
2138 | goto out_err; |
2139 | } else { | |
2140 | for_each_netdev_rcu(net, dev) { | |
2141 | if (idx < s_idx) | |
2142 | goto skip; | |
2143 | ||
56d09976 | 2144 | err = br_vlan_dump_dev(dev, skb, cb, dump_flags); |
8dcea187 NA |
2145 | if (err == -EMSGSIZE) |
2146 | break; | |
2147 | skip: | |
2148 | idx++; | |
2149 | } | |
2150 | } | |
2151 | cb->args[0] = idx; | |
2152 | rcu_read_unlock(); | |
2153 | ||
2154 | return skb->len; | |
2155 | ||
2156 | out_err: | |
2157 | rcu_read_unlock(); | |
2158 | ||
2159 | return err; | |
2160 | } | |
2161 | ||
f26b2965 | 2162 | static const struct nla_policy br_vlan_db_policy[BRIDGE_VLANDB_ENTRY_MAX + 1] = { |
8140860c JB |
2163 | [BRIDGE_VLANDB_ENTRY_INFO] = |
2164 | NLA_POLICY_EXACT_LEN(sizeof(struct bridge_vlan_info)), | |
0ab55879 | 2165 | [BRIDGE_VLANDB_ENTRY_RANGE] = { .type = NLA_U16 }, |
a580c76d | 2166 | [BRIDGE_VLANDB_ENTRY_STATE] = { .type = NLA_U8 }, |
fa388f29 | 2167 | [BRIDGE_VLANDB_ENTRY_TUNNEL_INFO] = { .type = NLA_NESTED }, |
2796d846 | 2168 | [BRIDGE_VLANDB_ENTRY_MCAST_ROUTER] = { .type = NLA_U8 }, |
a1aee20d PM |
2169 | [BRIDGE_VLANDB_ENTRY_MCAST_N_GROUPS] = { .type = NLA_REJECT }, |
2170 | [BRIDGE_VLANDB_ENTRY_MCAST_MAX_GROUPS] = { .type = NLA_U32 }, | |
83f6d600 | 2171 | [BRIDGE_VLANDB_ENTRY_NEIGH_SUPPRESS] = NLA_POLICY_MAX(NLA_U8, 1), |
f26b2965 NA |
2172 | }; |
2173 | ||
2174 | static int br_vlan_rtm_process_one(struct net_device *dev, | |
2175 | const struct nlattr *attr, | |
2176 | int cmd, struct netlink_ext_ack *extack) | |
2177 | { | |
0ab55879 | 2178 | struct bridge_vlan_info *vinfo, vrange_end, *vinfo_last = NULL; |
f26b2965 | 2179 | struct nlattr *tb[BRIDGE_VLANDB_ENTRY_MAX + 1]; |
a5d29ae2 | 2180 | bool changed = false, skip_processing = false; |
f26b2965 NA |
2181 | struct net_bridge_vlan_group *vg; |
2182 | struct net_bridge_port *p = NULL; | |
2183 | int err = 0, cmdmap = 0; | |
2184 | struct net_bridge *br; | |
f26b2965 NA |
2185 | |
2186 | if (netif_is_bridge_master(dev)) { | |
2187 | br = netdev_priv(dev); | |
2188 | vg = br_vlan_group(br); | |
2189 | } else { | |
2190 | p = br_port_get_rtnl(dev); | |
2191 | if (WARN_ON(!p)) | |
2192 | return -ENODEV; | |
2193 | br = p->br; | |
2194 | vg = nbp_vlan_group(p); | |
2195 | } | |
2196 | ||
2197 | if (WARN_ON(!vg)) | |
2198 | return -ENODEV; | |
2199 | ||
2200 | err = nla_parse_nested(tb, BRIDGE_VLANDB_ENTRY_MAX, attr, | |
2201 | br_vlan_db_policy, extack); | |
2202 | if (err) | |
2203 | return err; | |
2204 | ||
2205 | if (!tb[BRIDGE_VLANDB_ENTRY_INFO]) { | |
2206 | NL_SET_ERR_MSG_MOD(extack, "Missing vlan entry info"); | |
2207 | return -EINVAL; | |
2208 | } | |
0ab55879 | 2209 | memset(&vrange_end, 0, sizeof(vrange_end)); |
f26b2965 NA |
2210 | |
2211 | vinfo = nla_data(tb[BRIDGE_VLANDB_ENTRY_INFO]); | |
2212 | if (vinfo->flags & (BRIDGE_VLAN_INFO_RANGE_BEGIN | | |
2213 | BRIDGE_VLAN_INFO_RANGE_END)) { | |
2214 | NL_SET_ERR_MSG_MOD(extack, "Old-style vlan ranges are not allowed when using RTM vlan calls"); | |
2215 | return -EINVAL; | |
2216 | } | |
2217 | if (!br_vlan_valid_id(vinfo->vid, extack)) | |
2218 | return -EINVAL; | |
2219 | ||
0ab55879 NA |
2220 | if (tb[BRIDGE_VLANDB_ENTRY_RANGE]) { |
2221 | vrange_end.vid = nla_get_u16(tb[BRIDGE_VLANDB_ENTRY_RANGE]); | |
2222 | /* validate user-provided flags without RANGE_BEGIN */ | |
2223 | vrange_end.flags = BRIDGE_VLAN_INFO_RANGE_END | vinfo->flags; | |
2224 | vinfo->flags |= BRIDGE_VLAN_INFO_RANGE_BEGIN; | |
2225 | ||
2226 | /* vinfo_last is the range start, vinfo the range end */ | |
2227 | vinfo_last = vinfo; | |
2228 | vinfo = &vrange_end; | |
2229 | ||
2230 | if (!br_vlan_valid_id(vinfo->vid, extack) || | |
2231 | !br_vlan_valid_range(vinfo, vinfo_last, extack)) | |
2232 | return -EINVAL; | |
2233 | } | |
2234 | ||
f26b2965 NA |
2235 | switch (cmd) { |
2236 | case RTM_NEWVLAN: | |
2237 | cmdmap = RTM_SETLINK; | |
a5d29ae2 | 2238 | skip_processing = !!(vinfo->flags & BRIDGE_VLAN_INFO_ONLY_OPTS); |
f26b2965 | 2239 | break; |
adb3ce9b NA |
2240 | case RTM_DELVLAN: |
2241 | cmdmap = RTM_DELLINK; | |
2242 | break; | |
f26b2965 NA |
2243 | } |
2244 | ||
a5d29ae2 NA |
2245 | if (!skip_processing) { |
2246 | struct bridge_vlan_info *tmp_last = vinfo_last; | |
2247 | ||
2248 | /* br_process_vlan_info may overwrite vinfo_last */ | |
2249 | err = br_process_vlan_info(br, p, cmdmap, vinfo, &tmp_last, | |
2250 | &changed, extack); | |
2251 | ||
2252 | /* notify first if anything changed */ | |
2253 | if (changed) | |
2254 | br_ifinfo_notify(cmdmap, br, p); | |
2255 | ||
2256 | if (err) | |
2257 | return err; | |
2258 | } | |
2259 | ||
2260 | /* deal with options */ | |
2261 | if (cmd == RTM_NEWVLAN) { | |
2262 | struct net_bridge_vlan *range_start, *range_end; | |
2263 | ||
2264 | if (vinfo_last) { | |
2265 | range_start = br_vlan_find(vg, vinfo_last->vid); | |
2266 | range_end = br_vlan_find(vg, vinfo->vid); | |
2267 | } else { | |
2268 | range_start = br_vlan_find(vg, vinfo->vid); | |
2269 | range_end = range_start; | |
2270 | } | |
2271 | ||
2272 | err = br_vlan_process_options(br, p, range_start, range_end, | |
2273 | tb, extack); | |
2274 | } | |
f26b2965 NA |
2275 | |
2276 | return err; | |
2277 | } | |
2278 | ||
2279 | static int br_vlan_rtm_process(struct sk_buff *skb, struct nlmsghdr *nlh, | |
2280 | struct netlink_ext_ack *extack) | |
2281 | { | |
2282 | struct net *net = sock_net(skb->sk); | |
2283 | struct br_vlan_msg *bvm; | |
2284 | struct net_device *dev; | |
2285 | struct nlattr *attr; | |
2286 | int err, vlans = 0; | |
2287 | int rem; | |
2288 | ||
2289 | /* this should validate the header and check for remaining bytes */ | |
2290 | err = nlmsg_parse(nlh, sizeof(*bvm), NULL, BRIDGE_VLANDB_MAX, NULL, | |
2291 | extack); | |
2292 | if (err < 0) | |
2293 | return err; | |
2294 | ||
2295 | bvm = nlmsg_data(nlh); | |
2296 | dev = __dev_get_by_index(net, bvm->ifindex); | |
2297 | if (!dev) | |
2298 | return -ENODEV; | |
2299 | ||
2300 | if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev)) { | |
2301 | NL_SET_ERR_MSG_MOD(extack, "The device is not a valid bridge or bridge port"); | |
2302 | return -EINVAL; | |
2303 | } | |
2304 | ||
2305 | nlmsg_for_each_attr(attr, nlh, sizeof(*bvm), rem) { | |
47ecd2db NA |
2306 | switch (nla_type(attr)) { |
2307 | case BRIDGE_VLANDB_ENTRY: | |
2308 | err = br_vlan_rtm_process_one(dev, attr, | |
2309 | nlh->nlmsg_type, | |
2310 | extack); | |
2311 | break; | |
2312 | case BRIDGE_VLANDB_GLOBAL_OPTIONS: | |
2313 | err = br_vlan_rtm_process_global_options(dev, attr, | |
2314 | nlh->nlmsg_type, | |
2315 | extack); | |
2316 | break; | |
2317 | default: | |
f26b2965 | 2318 | continue; |
47ecd2db | 2319 | } |
f26b2965 NA |
2320 | |
2321 | vlans++; | |
f26b2965 NA |
2322 | if (err) |
2323 | break; | |
2324 | } | |
2325 | if (!vlans) { | |
2326 | NL_SET_ERR_MSG_MOD(extack, "No vlans found to process"); | |
2327 | err = -EINVAL; | |
2328 | } | |
2329 | ||
2330 | return err; | |
2331 | } | |
2332 | ||
cba5e43b KI |
2333 | static const struct rtnl_msg_handler br_vlan_rtnl_msg_handlers[] = { |
2334 | {THIS_MODULE, PF_BRIDGE, RTM_NEWVLAN, br_vlan_rtm_process, NULL, 0}, | |
2335 | {THIS_MODULE, PF_BRIDGE, RTM_DELVLAN, br_vlan_rtm_process, NULL, 0}, | |
2336 | {THIS_MODULE, PF_BRIDGE, RTM_GETVLAN, NULL, br_vlan_rtm_dump, 0}, | |
2337 | }; | |
2338 | ||
2339 | int br_vlan_rtnl_init(void) | |
8dcea187 | 2340 | { |
cba5e43b | 2341 | return rtnl_register_many(br_vlan_rtnl_msg_handlers); |
8dcea187 NA |
2342 | } |
2343 | ||
2344 | void br_vlan_rtnl_uninit(void) | |
2345 | { | |
cba5e43b | 2346 | rtnl_unregister_many(br_vlan_rtnl_msg_handlers); |
8dcea187 | 2347 | } |