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