xref: /openbmc/linux/net/bridge/br_vlan.c (revision 27c5f74c)
1457c8996SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2243a2e63SVlad Yasevich #include <linux/kernel.h>
3243a2e63SVlad Yasevich #include <linux/netdevice.h>
4243a2e63SVlad Yasevich #include <linux/rtnetlink.h>
5243a2e63SVlad Yasevich #include <linux/slab.h>
67f109539SScott Feldman #include <net/switchdev.h>
7243a2e63SVlad Yasevich 
8243a2e63SVlad Yasevich #include "br_private.h"
9efa5356bSRoopa Prabhu #include "br_private_tunnel.h"
10243a2e63SVlad Yasevich 
1180900acdSMike Manning static void nbp_vlan_set_vlan_dev_state(struct net_bridge_port *p, u16 vid);
1280900acdSMike Manning 
132594e906SNikolay Aleksandrov static inline int br_vlan_cmp(struct rhashtable_compare_arg *arg,
142594e906SNikolay Aleksandrov 			      const void *ptr)
15552406c4SVlad Yasevich {
162594e906SNikolay Aleksandrov 	const struct net_bridge_vlan *vle = ptr;
172594e906SNikolay Aleksandrov 	u16 vid = *(u16 *)arg->key;
182594e906SNikolay Aleksandrov 
192594e906SNikolay Aleksandrov 	return vle->vid != vid;
202594e906SNikolay Aleksandrov }
212594e906SNikolay Aleksandrov 
222594e906SNikolay Aleksandrov static const struct rhashtable_params br_vlan_rht_params = {
232594e906SNikolay Aleksandrov 	.head_offset = offsetof(struct net_bridge_vlan, vnode),
242594e906SNikolay Aleksandrov 	.key_offset = offsetof(struct net_bridge_vlan, vid),
252594e906SNikolay Aleksandrov 	.key_len = sizeof(u16),
268af78b64SNikolay Aleksandrov 	.nelem_hint = 3,
272594e906SNikolay Aleksandrov 	.max_size = VLAN_N_VID,
282594e906SNikolay Aleksandrov 	.obj_cmpfn = br_vlan_cmp,
292594e906SNikolay Aleksandrov 	.automatic_shrinking = true,
302594e906SNikolay Aleksandrov };
312594e906SNikolay Aleksandrov 
322594e906SNikolay Aleksandrov static struct net_bridge_vlan *br_vlan_lookup(struct rhashtable *tbl, u16 vid)
332594e906SNikolay Aleksandrov {
342594e906SNikolay Aleksandrov 	return rhashtable_lookup_fast(tbl, &vid, br_vlan_rht_params);
352594e906SNikolay Aleksandrov }
362594e906SNikolay Aleksandrov 
37*27c5f74cSVladimir Oltean static void __vlan_add_pvid(struct net_bridge_vlan_group *vg,
38a580c76dSNikolay Aleksandrov 			    const struct net_bridge_vlan *v)
392594e906SNikolay Aleksandrov {
40a580c76dSNikolay Aleksandrov 	if (vg->pvid == v->vid)
41*27c5f74cSVladimir Oltean 		return;
42552406c4SVlad Yasevich 
43552406c4SVlad Yasevich 	smp_wmb();
44a580c76dSNikolay Aleksandrov 	br_vlan_set_pvid_state(vg, v->state);
45a580c76dSNikolay Aleksandrov 	vg->pvid = v->vid;
46552406c4SVlad Yasevich }
47552406c4SVlad Yasevich 
48*27c5f74cSVladimir Oltean static void __vlan_delete_pvid(struct net_bridge_vlan_group *vg, u16 vid)
49552406c4SVlad Yasevich {
5077751ee8SNikolay Aleksandrov 	if (vg->pvid != vid)
51*27c5f74cSVladimir Oltean 		return;
52552406c4SVlad Yasevich 
53552406c4SVlad Yasevich 	smp_wmb();
5477751ee8SNikolay Aleksandrov 	vg->pvid = 0;
55552406c4SVlad Yasevich }
56552406c4SVlad Yasevich 
57*27c5f74cSVladimir Oltean /* Update the BRIDGE_VLAN_INFO_PVID and BRIDGE_VLAN_INFO_UNTAGGED flags of @v.
58*27c5f74cSVladimir Oltean  * If @commit is false, return just whether the BRIDGE_VLAN_INFO_PVID and
59*27c5f74cSVladimir Oltean  * BRIDGE_VLAN_INFO_UNTAGGED bits of @flags would produce any change onto @v.
60cab2cd77SVladimir Oltean  */
61*27c5f74cSVladimir Oltean static bool __vlan_flags_update(struct net_bridge_vlan *v, u16 flags,
62*27c5f74cSVladimir Oltean 				bool commit)
6335e03f3aSVlad Yasevich {
6477751ee8SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
65*27c5f74cSVladimir Oltean 	bool change;
6677751ee8SNikolay Aleksandrov 
672594e906SNikolay Aleksandrov 	if (br_vlan_is_master(v))
68907b1e6eSNikolay Aleksandrov 		vg = br_vlan_group(v->br);
69635126b7SVlad Yasevich 	else
70907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(v->port);
7177751ee8SNikolay Aleksandrov 
72*27c5f74cSVladimir Oltean 	/* check if anything would be changed on commit */
73*27c5f74cSVladimir Oltean 	change = !!(flags & BRIDGE_VLAN_INFO_PVID) == !!(vg->pvid != v->vid) ||
74*27c5f74cSVladimir Oltean 		 ((flags ^ v->flags) & BRIDGE_VLAN_INFO_UNTAGGED);
75*27c5f74cSVladimir Oltean 
76*27c5f74cSVladimir Oltean 	if (!commit)
77*27c5f74cSVladimir Oltean 		goto out;
78*27c5f74cSVladimir Oltean 
7977751ee8SNikolay Aleksandrov 	if (flags & BRIDGE_VLAN_INFO_PVID)
80*27c5f74cSVladimir Oltean 		__vlan_add_pvid(vg, v);
812594e906SNikolay Aleksandrov 	else
82*27c5f74cSVladimir Oltean 		__vlan_delete_pvid(vg, v->vid);
8335e03f3aSVlad Yasevich 
8435e03f3aSVlad Yasevich 	if (flags & BRIDGE_VLAN_INFO_UNTAGGED)
852594e906SNikolay Aleksandrov 		v->flags |= BRIDGE_VLAN_INFO_UNTAGGED;
86635126b7SVlad Yasevich 	else
872594e906SNikolay Aleksandrov 		v->flags &= ~BRIDGE_VLAN_INFO_UNTAGGED;
88f418af63SNikolay Aleksandrov 
89*27c5f74cSVladimir Oltean out:
90*27c5f74cSVladimir Oltean 	return change;
91*27c5f74cSVladimir Oltean }
92*27c5f74cSVladimir Oltean 
93*27c5f74cSVladimir Oltean static bool __vlan_flags_would_change(struct net_bridge_vlan *v, u16 flags)
94*27c5f74cSVladimir Oltean {
95*27c5f74cSVladimir Oltean 	return __vlan_flags_update(v, flags, false);
96*27c5f74cSVladimir Oltean }
97*27c5f74cSVladimir Oltean 
98*27c5f74cSVladimir Oltean static void __vlan_flags_commit(struct net_bridge_vlan *v, u16 flags)
99*27c5f74cSVladimir Oltean {
100*27c5f74cSVladimir Oltean 	__vlan_flags_update(v, flags, true);
10135e03f3aSVlad Yasevich }
10235e03f3aSVlad Yasevich 
1037f109539SScott Feldman static int __vlan_vid_add(struct net_device *dev, struct net_bridge *br,
10427973793SIdo Schimmel 			  struct net_bridge_vlan *v, u16 flags,
10527973793SIdo Schimmel 			  struct netlink_ext_ack *extack)
1067f109539SScott Feldman {
1070944d6b5SJiri Pirko 	int err;
1087f109539SScott Feldman 
1090944d6b5SJiri Pirko 	/* Try switchdev op first. In case it is not supported, fallback to
1100944d6b5SJiri Pirko 	 * 8021q add.
1110944d6b5SJiri Pirko 	 */
11227973793SIdo Schimmel 	err = br_switchdev_port_vlan_add(dev, v->vid, flags, extack);
1137f109539SScott Feldman 	if (err == -EOPNOTSUPP)
11427973793SIdo Schimmel 		return vlan_vid_add(dev, br->vlan_proto, v->vid);
11527973793SIdo Schimmel 	v->priv_flags |= BR_VLFLAG_ADDED_BY_SWITCHDEV;
1167f109539SScott Feldman 	return err;
1177f109539SScott Feldman }
1187f109539SScott Feldman 
1192594e906SNikolay Aleksandrov static void __vlan_add_list(struct net_bridge_vlan *v)
120243a2e63SVlad Yasevich {
121907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
1222594e906SNikolay Aleksandrov 	struct list_head *headp, *hpos;
1232594e906SNikolay Aleksandrov 	struct net_bridge_vlan *vent;
124243a2e63SVlad Yasevich 
125907b1e6eSNikolay Aleksandrov 	if (br_vlan_is_master(v))
126907b1e6eSNikolay Aleksandrov 		vg = br_vlan_group(v->br);
127907b1e6eSNikolay Aleksandrov 	else
128907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(v->port);
129907b1e6eSNikolay Aleksandrov 
130907b1e6eSNikolay Aleksandrov 	headp = &vg->vlan_list;
1312594e906SNikolay Aleksandrov 	list_for_each_prev(hpos, headp) {
1322594e906SNikolay Aleksandrov 		vent = list_entry(hpos, struct net_bridge_vlan, vlist);
133040c1257SColin Ian King 		if (v->vid >= vent->vid)
1342594e906SNikolay Aleksandrov 			break;
1352594e906SNikolay Aleksandrov 	}
136586c2b57SNikolay Aleksandrov 	list_add_rcu(&v->vlist, hpos);
137552406c4SVlad Yasevich }
138243a2e63SVlad Yasevich 
1392594e906SNikolay Aleksandrov static void __vlan_del_list(struct net_bridge_vlan *v)
1402594e906SNikolay Aleksandrov {
141586c2b57SNikolay Aleksandrov 	list_del_rcu(&v->vlist);
142243a2e63SVlad Yasevich }
143243a2e63SVlad Yasevich 
144bf361ad3SVivien Didelot static int __vlan_vid_del(struct net_device *dev, struct net_bridge *br,
14527973793SIdo Schimmel 			  const struct net_bridge_vlan *v)
1467f109539SScott Feldman {
1470944d6b5SJiri Pirko 	int err;
1487f109539SScott Feldman 
1490944d6b5SJiri Pirko 	/* Try switchdev op first. In case it is not supported, fallback to
1500944d6b5SJiri Pirko 	 * 8021q del.
1510944d6b5SJiri Pirko 	 */
15227973793SIdo Schimmel 	err = br_switchdev_port_vlan_del(dev, v->vid);
15327973793SIdo Schimmel 	if (!(v->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV))
15427973793SIdo Schimmel 		vlan_vid_del(dev, br->vlan_proto, v->vid);
15527973793SIdo Schimmel 	return err == -EOPNOTSUPP ? 0 : err;
1567f109539SScott Feldman }
1577f109539SScott Feldman 
1584bbd026cSRandy Dunlap /* Returns a master vlan, if it didn't exist it gets created. In all cases
159f8ed289fSNikolay Aleksandrov  * a reference is taken to the master vlan before returning.
160f8ed289fSNikolay Aleksandrov  */
161169327d5SPetr Machata static struct net_bridge_vlan *
162169327d5SPetr Machata br_vlan_get_master(struct net_bridge *br, u16 vid,
163169327d5SPetr Machata 		   struct netlink_ext_ack *extack)
164f8ed289fSNikolay Aleksandrov {
165907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
166f8ed289fSNikolay Aleksandrov 	struct net_bridge_vlan *masterv;
167f8ed289fSNikolay Aleksandrov 
168907b1e6eSNikolay Aleksandrov 	vg = br_vlan_group(br);
169907b1e6eSNikolay Aleksandrov 	masterv = br_vlan_find(vg, vid);
170f8ed289fSNikolay Aleksandrov 	if (!masterv) {
171f418af63SNikolay Aleksandrov 		bool changed;
172f418af63SNikolay Aleksandrov 
173f8ed289fSNikolay Aleksandrov 		/* missing global ctx, create it now */
174169327d5SPetr Machata 		if (br_vlan_add(br, vid, 0, &changed, extack))
175f8ed289fSNikolay Aleksandrov 			return NULL;
176907b1e6eSNikolay Aleksandrov 		masterv = br_vlan_find(vg, vid);
177f8ed289fSNikolay Aleksandrov 		if (WARN_ON(!masterv))
178f8ed289fSNikolay Aleksandrov 			return NULL;
1790e5a82efSIdo Schimmel 		refcount_set(&masterv->refcnt, 1);
1800e5a82efSIdo Schimmel 		return masterv;
181f8ed289fSNikolay Aleksandrov 	}
18225127759SReshetova, Elena 	refcount_inc(&masterv->refcnt);
183f8ed289fSNikolay Aleksandrov 
184f8ed289fSNikolay Aleksandrov 	return masterv;
185f8ed289fSNikolay Aleksandrov }
186f8ed289fSNikolay Aleksandrov 
1876dada9b1SNikolay Aleksandrov static void br_master_vlan_rcu_free(struct rcu_head *rcu)
1886dada9b1SNikolay Aleksandrov {
1896dada9b1SNikolay Aleksandrov 	struct net_bridge_vlan *v;
1906dada9b1SNikolay Aleksandrov 
1916dada9b1SNikolay Aleksandrov 	v = container_of(rcu, struct net_bridge_vlan, rcu);
1926dada9b1SNikolay Aleksandrov 	WARN_ON(!br_vlan_is_master(v));
1936dada9b1SNikolay Aleksandrov 	free_percpu(v->stats);
1946dada9b1SNikolay Aleksandrov 	v->stats = NULL;
1956dada9b1SNikolay Aleksandrov 	kfree(v);
1966dada9b1SNikolay Aleksandrov }
1976dada9b1SNikolay Aleksandrov 
198f8ed289fSNikolay Aleksandrov static void br_vlan_put_master(struct net_bridge_vlan *masterv)
199f8ed289fSNikolay Aleksandrov {
200907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
201907b1e6eSNikolay Aleksandrov 
202f8ed289fSNikolay Aleksandrov 	if (!br_vlan_is_master(masterv))
203f8ed289fSNikolay Aleksandrov 		return;
204f8ed289fSNikolay Aleksandrov 
205907b1e6eSNikolay Aleksandrov 	vg = br_vlan_group(masterv->br);
20625127759SReshetova, Elena 	if (refcount_dec_and_test(&masterv->refcnt)) {
207907b1e6eSNikolay Aleksandrov 		rhashtable_remove_fast(&vg->vlan_hash,
208f8ed289fSNikolay Aleksandrov 				       &masterv->vnode, br_vlan_rht_params);
209f8ed289fSNikolay Aleksandrov 		__vlan_del_list(masterv);
2107b54aaafSNikolay Aleksandrov 		br_multicast_toggle_one_vlan(masterv, false);
211613d61dbSNikolay Aleksandrov 		br_multicast_ctx_deinit(&masterv->br_mcast_ctx);
2126dada9b1SNikolay Aleksandrov 		call_rcu(&masterv->rcu, br_master_vlan_rcu_free);
213f8ed289fSNikolay Aleksandrov 	}
214f8ed289fSNikolay Aleksandrov }
215f8ed289fSNikolay Aleksandrov 
2169163a0fcSNikolay Aleksandrov static void nbp_vlan_rcu_free(struct rcu_head *rcu)
2179163a0fcSNikolay Aleksandrov {
2189163a0fcSNikolay Aleksandrov 	struct net_bridge_vlan *v;
2199163a0fcSNikolay Aleksandrov 
2209163a0fcSNikolay Aleksandrov 	v = container_of(rcu, struct net_bridge_vlan, rcu);
2219163a0fcSNikolay Aleksandrov 	WARN_ON(br_vlan_is_master(v));
2229163a0fcSNikolay Aleksandrov 	/* if we had per-port stats configured then free them here */
2239d332e69SNikolay Aleksandrov 	if (v->priv_flags & BR_VLFLAG_PER_PORT_STATS)
2249163a0fcSNikolay Aleksandrov 		free_percpu(v->stats);
2259163a0fcSNikolay Aleksandrov 	v->stats = NULL;
2269163a0fcSNikolay Aleksandrov 	kfree(v);
2279163a0fcSNikolay Aleksandrov }
2289163a0fcSNikolay Aleksandrov 
2292594e906SNikolay Aleksandrov /* This is the shared VLAN add function which works for both ports and bridge
2302594e906SNikolay Aleksandrov  * devices. There are four possible calls to this function in terms of the
2312594e906SNikolay Aleksandrov  * vlan entry type:
2322594e906SNikolay Aleksandrov  * 1. vlan is being added on a port (no master flags, global entry exists)
233ddd611d3SIdo Schimmel  * 2. vlan is being added on a bridge (both master and brentry flags)
2342594e906SNikolay Aleksandrov  * 3. vlan is being added on a port, but a global entry didn't exist which
235ddd611d3SIdo Schimmel  *    is being created right now (master flag set, brentry flag unset), the
2362594e906SNikolay Aleksandrov  *    global entry is used for global per-vlan features, but not for filtering
237ddd611d3SIdo Schimmel  * 4. same as 3 but with both master and brentry flags set so the entry
2382594e906SNikolay Aleksandrov  *    will be used for filtering in both the port and the bridge
2392594e906SNikolay Aleksandrov  */
240169327d5SPetr Machata static int __vlan_add(struct net_bridge_vlan *v, u16 flags,
241169327d5SPetr Machata 		      struct netlink_ext_ack *extack)
242243a2e63SVlad Yasevich {
2432594e906SNikolay Aleksandrov 	struct net_bridge_vlan *masterv = NULL;
2442594e906SNikolay Aleksandrov 	struct net_bridge_port *p = NULL;
2456be144f6SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
2462594e906SNikolay Aleksandrov 	struct net_device *dev;
2472594e906SNikolay Aleksandrov 	struct net_bridge *br;
248bf361ad3SVivien Didelot 	int err;
249bf361ad3SVivien Didelot 
2502594e906SNikolay Aleksandrov 	if (br_vlan_is_master(v)) {
2512594e906SNikolay Aleksandrov 		br = v->br;
2522594e906SNikolay Aleksandrov 		dev = br->dev;
253907b1e6eSNikolay Aleksandrov 		vg = br_vlan_group(br);
2542594e906SNikolay Aleksandrov 	} else {
2552594e906SNikolay Aleksandrov 		p = v->port;
2562594e906SNikolay Aleksandrov 		br = p->br;
2572594e906SNikolay Aleksandrov 		dev = p->dev;
258907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(p);
2592594e906SNikolay Aleksandrov 	}
2602594e906SNikolay Aleksandrov 
2612594e906SNikolay Aleksandrov 	if (p) {
2622594e906SNikolay Aleksandrov 		/* Add VLAN to the device filter if it is supported.
2632594e906SNikolay Aleksandrov 		 * This ensures tagged traffic enters the bridge when
2642594e906SNikolay Aleksandrov 		 * promiscuous mode is disabled by br_manage_promisc().
2652594e906SNikolay Aleksandrov 		 */
26627973793SIdo Schimmel 		err = __vlan_vid_add(dev, br, v, flags, extack);
267bf361ad3SVivien Didelot 		if (err)
2682594e906SNikolay Aleksandrov 			goto out;
2692594e906SNikolay Aleksandrov 
2702594e906SNikolay Aleksandrov 		/* need to work on the master vlan too */
2712594e906SNikolay Aleksandrov 		if (flags & BRIDGE_VLAN_INFO_MASTER) {
272f418af63SNikolay Aleksandrov 			bool changed;
273f418af63SNikolay Aleksandrov 
274f418af63SNikolay Aleksandrov 			err = br_vlan_add(br, v->vid,
275f418af63SNikolay Aleksandrov 					  flags | BRIDGE_VLAN_INFO_BRENTRY,
276169327d5SPetr Machata 					  &changed, extack);
2772594e906SNikolay Aleksandrov 			if (err)
2782594e906SNikolay Aleksandrov 				goto out_filt;
279f545923bSNikolay Aleksandrov 
280f545923bSNikolay Aleksandrov 			if (changed)
281f545923bSNikolay Aleksandrov 				br_vlan_notify(br, NULL, v->vid, 0,
282f545923bSNikolay Aleksandrov 					       RTM_NEWVLAN);
2832594e906SNikolay Aleksandrov 		}
2842594e906SNikolay Aleksandrov 
285169327d5SPetr Machata 		masterv = br_vlan_get_master(br, v->vid, extack);
286ee4f52a8SZhang Changzhong 		if (!masterv) {
287ee4f52a8SZhang Changzhong 			err = -ENOMEM;
2882594e906SNikolay Aleksandrov 			goto out_filt;
289ee4f52a8SZhang Changzhong 		}
2902594e906SNikolay Aleksandrov 		v->brvlan = masterv;
2919163a0fcSNikolay Aleksandrov 		if (br_opt_get(br, BROPT_VLAN_STATS_PER_PORT)) {
292281cc284SHeiner Kallweit 			v->stats =
293281cc284SHeiner Kallweit 			     netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
2949163a0fcSNikolay Aleksandrov 			if (!v->stats) {
2959163a0fcSNikolay Aleksandrov 				err = -ENOMEM;
2969163a0fcSNikolay Aleksandrov 				goto out_filt;
2979163a0fcSNikolay Aleksandrov 			}
2989d332e69SNikolay Aleksandrov 			v->priv_flags |= BR_VLFLAG_PER_PORT_STATS;
2999163a0fcSNikolay Aleksandrov 		} else {
3006dada9b1SNikolay Aleksandrov 			v->stats = masterv->stats;
3019163a0fcSNikolay Aleksandrov 		}
302613d61dbSNikolay Aleksandrov 		br_multicast_port_ctx_init(p, v, &v->port_mcast_ctx);
3039c86ce2cSPetr Machata 	} else {
3043116ad06SVladimir Oltean 		if (br_vlan_should_use(v)) {
3053116ad06SVladimir Oltean 			err = br_switchdev_port_vlan_add(dev, v->vid, flags,
3063116ad06SVladimir Oltean 							 extack);
3079c86ce2cSPetr Machata 			if (err && err != -EOPNOTSUPP)
3089c86ce2cSPetr Machata 				goto out;
3093116ad06SVladimir Oltean 		}
310613d61dbSNikolay Aleksandrov 		br_multicast_ctx_init(br, v, &v->br_mcast_ctx);
3117b54aaafSNikolay Aleksandrov 		v->priv_flags |= BR_VLFLAG_GLOBAL_MCAST_ENABLED;
3122594e906SNikolay Aleksandrov 	}
3132594e906SNikolay Aleksandrov 
3146be144f6SNikolay Aleksandrov 	/* Add the dev mac and count the vlan only if it's usable */
3152594e906SNikolay Aleksandrov 	if (br_vlan_should_use(v)) {
316f6814fdcSVladimir Oltean 		err = br_fdb_add_local(br, p, dev->dev_addr, v->vid);
3172594e906SNikolay Aleksandrov 		if (err) {
3182594e906SNikolay Aleksandrov 			br_err(br, "failed insert local address into bridge forwarding table\n");
3192594e906SNikolay Aleksandrov 			goto out_filt;
3202594e906SNikolay Aleksandrov 		}
3216be144f6SNikolay Aleksandrov 		vg->num_vlans++;
3222594e906SNikolay Aleksandrov 	}
3232594e906SNikolay Aleksandrov 
324a580c76dSNikolay Aleksandrov 	/* set the state before publishing */
325a580c76dSNikolay Aleksandrov 	v->state = BR_STATE_FORWARDING;
326a580c76dSNikolay Aleksandrov 
3276be144f6SNikolay Aleksandrov 	err = rhashtable_lookup_insert_fast(&vg->vlan_hash, &v->vnode,
3286be144f6SNikolay Aleksandrov 					    br_vlan_rht_params);
3292594e906SNikolay Aleksandrov 	if (err)
3302594e906SNikolay Aleksandrov 		goto out_fdb_insert;
3312594e906SNikolay Aleksandrov 
3322594e906SNikolay Aleksandrov 	__vlan_add_list(v);
333*27c5f74cSVladimir Oltean 	__vlan_flags_commit(v, flags);
3347b54aaafSNikolay Aleksandrov 	br_multicast_toggle_one_vlan(v, true);
33580900acdSMike Manning 
33680900acdSMike Manning 	if (p)
33780900acdSMike Manning 		nbp_vlan_set_vlan_dev_state(p, v->vid);
3382594e906SNikolay Aleksandrov out:
3392594e906SNikolay Aleksandrov 	return err;
3402594e906SNikolay Aleksandrov 
3412594e906SNikolay Aleksandrov out_fdb_insert:
3426be144f6SNikolay Aleksandrov 	if (br_vlan_should_use(v)) {
3436be144f6SNikolay Aleksandrov 		br_fdb_find_delete_local(br, p, dev->dev_addr, v->vid);
3446be144f6SNikolay Aleksandrov 		vg->num_vlans--;
3456be144f6SNikolay Aleksandrov 	}
3462594e906SNikolay Aleksandrov 
3472594e906SNikolay Aleksandrov out_filt:
3482594e906SNikolay Aleksandrov 	if (p) {
34927973793SIdo Schimmel 		__vlan_vid_del(dev, br, v);
3502594e906SNikolay Aleksandrov 		if (masterv) {
3511a3aea25SLi RongQing 			if (v->stats && masterv->stats != v->stats)
3521a3aea25SLi RongQing 				free_percpu(v->stats);
3531a3aea25SLi RongQing 			v->stats = NULL;
3541a3aea25SLi RongQing 
355f8ed289fSNikolay Aleksandrov 			br_vlan_put_master(masterv);
3562594e906SNikolay Aleksandrov 			v->brvlan = NULL;
3572594e906SNikolay Aleksandrov 		}
3589c86ce2cSPetr Machata 	} else {
3599c86ce2cSPetr Machata 		br_switchdev_port_vlan_del(dev, v->vid);
3602594e906SNikolay Aleksandrov 	}
3612594e906SNikolay Aleksandrov 
3622594e906SNikolay Aleksandrov 	goto out;
3632594e906SNikolay Aleksandrov }
3642594e906SNikolay Aleksandrov 
3652594e906SNikolay Aleksandrov static int __vlan_del(struct net_bridge_vlan *v)
3662594e906SNikolay Aleksandrov {
3672594e906SNikolay Aleksandrov 	struct net_bridge_vlan *masterv = v;
36877751ee8SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
3692594e906SNikolay Aleksandrov 	struct net_bridge_port *p = NULL;
3702594e906SNikolay Aleksandrov 	int err = 0;
3712594e906SNikolay Aleksandrov 
3722594e906SNikolay Aleksandrov 	if (br_vlan_is_master(v)) {
373907b1e6eSNikolay Aleksandrov 		vg = br_vlan_group(v->br);
3742594e906SNikolay Aleksandrov 	} else {
3752594e906SNikolay Aleksandrov 		p = v->port;
376907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(v->port);
3772594e906SNikolay Aleksandrov 		masterv = v->brvlan;
3782594e906SNikolay Aleksandrov 	}
3792594e906SNikolay Aleksandrov 
38077751ee8SNikolay Aleksandrov 	__vlan_delete_pvid(vg, v->vid);
3812594e906SNikolay Aleksandrov 	if (p) {
38227973793SIdo Schimmel 		err = __vlan_vid_del(p->dev, p->br, v);
3832594e906SNikolay Aleksandrov 		if (err)
3842594e906SNikolay Aleksandrov 			goto out;
3859c86ce2cSPetr Machata 	} else {
3869c86ce2cSPetr Machata 		err = br_switchdev_port_vlan_del(v->br->dev, v->vid);
3879c86ce2cSPetr Machata 		if (err && err != -EOPNOTSUPP)
3889c86ce2cSPetr Machata 			goto out;
3899c86ce2cSPetr Machata 		err = 0;
3902594e906SNikolay Aleksandrov 	}
3912594e906SNikolay Aleksandrov 
3926be144f6SNikolay Aleksandrov 	if (br_vlan_should_use(v)) {
3932594e906SNikolay Aleksandrov 		v->flags &= ~BRIDGE_VLAN_INFO_BRENTRY;
3946be144f6SNikolay Aleksandrov 		vg->num_vlans--;
3952594e906SNikolay Aleksandrov 	}
3962594e906SNikolay Aleksandrov 
3972594e906SNikolay Aleksandrov 	if (masterv != v) {
398efa5356bSRoopa Prabhu 		vlan_tunnel_info_del(vg, v);
39977751ee8SNikolay Aleksandrov 		rhashtable_remove_fast(&vg->vlan_hash, &v->vnode,
40077751ee8SNikolay Aleksandrov 				       br_vlan_rht_params);
4012594e906SNikolay Aleksandrov 		__vlan_del_list(v);
40280900acdSMike Manning 		nbp_vlan_set_vlan_dev_state(p, v->vid);
4037b54aaafSNikolay Aleksandrov 		br_multicast_toggle_one_vlan(v, false);
404613d61dbSNikolay Aleksandrov 		br_multicast_port_ctx_deinit(&v->port_mcast_ctx);
4059163a0fcSNikolay Aleksandrov 		call_rcu(&v->rcu, nbp_vlan_rcu_free);
4062594e906SNikolay Aleksandrov 	}
4072594e906SNikolay Aleksandrov 
408f8ed289fSNikolay Aleksandrov 	br_vlan_put_master(masterv);
4092594e906SNikolay Aleksandrov out:
410bf361ad3SVivien Didelot 	return err;
4118580e211SToshiaki Makita }
412243a2e63SVlad Yasevich 
413f409d0edSNikolay Aleksandrov static void __vlan_group_free(struct net_bridge_vlan_group *vg)
414f409d0edSNikolay Aleksandrov {
415f409d0edSNikolay Aleksandrov 	WARN_ON(!list_empty(&vg->vlan_list));
416f409d0edSNikolay Aleksandrov 	rhashtable_destroy(&vg->vlan_hash);
417efa5356bSRoopa Prabhu 	vlan_tunnel_deinit(vg);
418f409d0edSNikolay Aleksandrov 	kfree(vg);
419f409d0edSNikolay Aleksandrov }
420f409d0edSNikolay Aleksandrov 
421f545923bSNikolay Aleksandrov static void __vlan_flush(const struct net_bridge *br,
422f545923bSNikolay Aleksandrov 			 const struct net_bridge_port *p,
423f545923bSNikolay Aleksandrov 			 struct net_bridge_vlan_group *vg)
424243a2e63SVlad Yasevich {
4252594e906SNikolay Aleksandrov 	struct net_bridge_vlan *vlan, *tmp;
426f545923bSNikolay Aleksandrov 	u16 v_start = 0, v_end = 0;
4275454f5c2SVladimir Oltean 	int err;
4282594e906SNikolay Aleksandrov 
429f409d0edSNikolay Aleksandrov 	__vlan_delete_pvid(vg, vg->pvid);
430f545923bSNikolay Aleksandrov 	list_for_each_entry_safe(vlan, tmp, &vg->vlan_list, vlist) {
431f545923bSNikolay Aleksandrov 		/* take care of disjoint ranges */
432f545923bSNikolay Aleksandrov 		if (!v_start) {
433f545923bSNikolay Aleksandrov 			v_start = vlan->vid;
434f545923bSNikolay Aleksandrov 		} else if (vlan->vid - v_end != 1) {
435f545923bSNikolay Aleksandrov 			/* found range end, notify and start next one */
436f545923bSNikolay Aleksandrov 			br_vlan_notify(br, p, v_start, v_end, RTM_DELVLAN);
437f545923bSNikolay Aleksandrov 			v_start = vlan->vid;
438f545923bSNikolay Aleksandrov 		}
439f545923bSNikolay Aleksandrov 		v_end = vlan->vid;
440f545923bSNikolay Aleksandrov 
4415454f5c2SVladimir Oltean 		err = __vlan_del(vlan);
4425454f5c2SVladimir Oltean 		if (err) {
4435454f5c2SVladimir Oltean 			br_err(br,
4445454f5c2SVladimir Oltean 			       "port %u(%s) failed to delete vlan %d: %pe\n",
4455454f5c2SVladimir Oltean 			       (unsigned int) p->port_no, p->dev->name,
4465454f5c2SVladimir Oltean 			       vlan->vid, ERR_PTR(err));
4475454f5c2SVladimir Oltean 		}
448243a2e63SVlad Yasevich 	}
449243a2e63SVlad Yasevich 
450f545923bSNikolay Aleksandrov 	/* notify about the last/whole vlan range */
451f545923bSNikolay Aleksandrov 	if (v_start)
452f545923bSNikolay Aleksandrov 		br_vlan_notify(br, p, v_start, v_end, RTM_DELVLAN);
453f545923bSNikolay Aleksandrov }
454f545923bSNikolay Aleksandrov 
45578851988SVlad Yasevich struct sk_buff *br_handle_vlan(struct net_bridge *br,
45611538d03SRoopa Prabhu 			       const struct net_bridge_port *p,
4572594e906SNikolay Aleksandrov 			       struct net_bridge_vlan_group *vg,
458a37b85c9SVlad Yasevich 			       struct sk_buff *skb)
459a37b85c9SVlad Yasevich {
460281cc284SHeiner Kallweit 	struct pcpu_sw_netstats *stats;
4612594e906SNikolay Aleksandrov 	struct net_bridge_vlan *v;
462a37b85c9SVlad Yasevich 	u16 vid;
463a37b85c9SVlad Yasevich 
46420adfa1aSVlad Yasevich 	/* If this packet was not filtered at input, let it pass */
46520adfa1aSVlad Yasevich 	if (!BR_INPUT_SKB_CB(skb)->vlan_filtered)
46678851988SVlad Yasevich 		goto out;
46778851988SVlad Yasevich 
4682594e906SNikolay Aleksandrov 	/* At this point, we know that the frame was filtered and contains
4692594e906SNikolay Aleksandrov 	 * a valid vlan id.  If the vlan id has untagged flag set,
4702594e906SNikolay Aleksandrov 	 * send untagged; otherwise, send tagged.
4712594e906SNikolay Aleksandrov 	 */
4722594e906SNikolay Aleksandrov 	br_vlan_get_tag(skb, &vid);
4732594e906SNikolay Aleksandrov 	v = br_vlan_find(vg, vid);
4742594e906SNikolay Aleksandrov 	/* Vlan entry must be configured at this point.  The
475fc92f745SVlad Yasevich 	 * only exception is the bridge is set in promisc mode and the
476fc92f745SVlad Yasevich 	 * packet is destined for the bridge device.  In this case
477fc92f745SVlad Yasevich 	 * pass the packet as is.
478fc92f745SVlad Yasevich 	 */
4792594e906SNikolay Aleksandrov 	if (!v || !br_vlan_should_use(v)) {
480fc92f745SVlad Yasevich 		if ((br->dev->flags & IFF_PROMISC) && skb->dev == br->dev) {
481fc92f745SVlad Yasevich 			goto out;
482fc92f745SVlad Yasevich 		} else {
483fc92f745SVlad Yasevich 			kfree_skb(skb);
484fc92f745SVlad Yasevich 			return NULL;
485fc92f745SVlad Yasevich 		}
486fc92f745SVlad Yasevich 	}
487ae75767eSNikolay Aleksandrov 	if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) {
4886dada9b1SNikolay Aleksandrov 		stats = this_cpu_ptr(v->stats);
4896dada9b1SNikolay Aleksandrov 		u64_stats_update_begin(&stats->syncp);
4906dada9b1SNikolay Aleksandrov 		stats->tx_bytes += skb->len;
4916dada9b1SNikolay Aleksandrov 		stats->tx_packets++;
4926dada9b1SNikolay Aleksandrov 		u64_stats_update_end(&stats->syncp);
4936dada9b1SNikolay Aleksandrov 	}
4946dada9b1SNikolay Aleksandrov 
49547211192STobias Waldekranz 	/* If the skb will be sent using forwarding offload, the assumption is
49647211192STobias Waldekranz 	 * that the switchdev will inject the packet into hardware together
49747211192STobias Waldekranz 	 * with the bridge VLAN, so that it can be forwarded according to that
49847211192STobias Waldekranz 	 * VLAN. The switchdev should deal with popping the VLAN header in
49947211192STobias Waldekranz 	 * hardware on each egress port as appropriate. So only strip the VLAN
50047211192STobias Waldekranz 	 * header if forwarding offload is not being used.
50147211192STobias Waldekranz 	 */
50247211192STobias Waldekranz 	if (v->flags & BRIDGE_VLAN_INFO_UNTAGGED &&
50347211192STobias Waldekranz 	    !br_switchdev_frame_uses_tx_fwd_offload(skb))
5045978f8a9SMichał Mirosław 		__vlan_hwaccel_clear_tag(skb);
50511538d03SRoopa Prabhu 
50611538d03SRoopa Prabhu 	if (p && (p->flags & BR_VLAN_TUNNEL) &&
50711538d03SRoopa Prabhu 	    br_handle_egress_vlan_tunnel(skb, v)) {
50811538d03SRoopa Prabhu 		kfree_skb(skb);
50911538d03SRoopa Prabhu 		return NULL;
51011538d03SRoopa Prabhu 	}
51178851988SVlad Yasevich out:
51278851988SVlad Yasevich 	return skb;
51378851988SVlad Yasevich }
51478851988SVlad Yasevich 
51578851988SVlad Yasevich /* Called under RCU */
5166dada9b1SNikolay Aleksandrov static bool __allowed_ingress(const struct net_bridge *br,
5176dada9b1SNikolay Aleksandrov 			      struct net_bridge_vlan_group *vg,
518a580c76dSNikolay Aleksandrov 			      struct sk_buff *skb, u16 *vid,
519f4b7002aSNikolay Aleksandrov 			      u8 *state,
520f4b7002aSNikolay Aleksandrov 			      struct net_bridge_vlan **vlan)
52178851988SVlad Yasevich {
522281cc284SHeiner Kallweit 	struct pcpu_sw_netstats *stats;
5236dada9b1SNikolay Aleksandrov 	struct net_bridge_vlan *v;
5248580e211SToshiaki Makita 	bool tagged;
525a37b85c9SVlad Yasevich 
52620adfa1aSVlad Yasevich 	BR_INPUT_SKB_CB(skb)->vlan_filtered = true;
52712464bb8SToshiaki Makita 	/* If vlan tx offload is disabled on bridge device and frame was
52812464bb8SToshiaki Makita 	 * sent from vlan device on the bridge device, it does not have
52912464bb8SToshiaki Makita 	 * HW accelerated vlan tag.
53012464bb8SToshiaki Makita 	 */
531df8a39deSJiri Pirko 	if (unlikely(!skb_vlan_tag_present(skb) &&
5326dada9b1SNikolay Aleksandrov 		     skb->protocol == br->vlan_proto)) {
5330d5501c1SVlad Yasevich 		skb = skb_vlan_untag(skb);
53412464bb8SToshiaki Makita 		if (unlikely(!skb))
53512464bb8SToshiaki Makita 			return false;
53612464bb8SToshiaki Makita 	}
53712464bb8SToshiaki Makita 
5388580e211SToshiaki Makita 	if (!br_vlan_get_tag(skb, vid)) {
5398580e211SToshiaki Makita 		/* Tagged frame */
5406dada9b1SNikolay Aleksandrov 		if (skb->vlan_proto != br->vlan_proto) {
5418580e211SToshiaki Makita 			/* Protocol-mismatch, empty out vlan_tci for new tag */
5428580e211SToshiaki Makita 			skb_push(skb, ETH_HLEN);
54362749e2cSJiri Pirko 			skb = vlan_insert_tag_set_proto(skb, skb->vlan_proto,
544df8a39deSJiri Pirko 							skb_vlan_tag_get(skb));
5458580e211SToshiaki Makita 			if (unlikely(!skb))
5468580e211SToshiaki Makita 				return false;
5478580e211SToshiaki Makita 
5488580e211SToshiaki Makita 			skb_pull(skb, ETH_HLEN);
5498580e211SToshiaki Makita 			skb_reset_mac_len(skb);
5508580e211SToshiaki Makita 			*vid = 0;
5518580e211SToshiaki Makita 			tagged = false;
5528580e211SToshiaki Makita 		} else {
5538580e211SToshiaki Makita 			tagged = true;
5548580e211SToshiaki Makita 		}
5558580e211SToshiaki Makita 	} else {
5568580e211SToshiaki Makita 		/* Untagged frame */
5578580e211SToshiaki Makita 		tagged = false;
5588580e211SToshiaki Makita 	}
5598580e211SToshiaki Makita 
560b90356ceSToshiaki Makita 	if (!*vid) {
56177751ee8SNikolay Aleksandrov 		u16 pvid = br_get_pvid(vg);
56277751ee8SNikolay Aleksandrov 
563b90356ceSToshiaki Makita 		/* Frame had a tag with VID 0 or did not have a tag.
564b90356ceSToshiaki Makita 		 * See if pvid is set on this port.  That tells us which
565b90356ceSToshiaki Makita 		 * vlan untagged or priority-tagged traffic belongs to.
56678851988SVlad Yasevich 		 */
5673df6bf45SVlad Yasevich 		if (!pvid)
568eb707618SToshiaki Makita 			goto drop;
56978851988SVlad Yasevich 
570b90356ceSToshiaki Makita 		/* PVID is set on this port.  Any untagged or priority-tagged
571b90356ceSToshiaki Makita 		 * ingress frame is considered to belong to this vlan.
57278851988SVlad Yasevich 		 */
573dfb5fa32SToshiaki Makita 		*vid = pvid;
5748580e211SToshiaki Makita 		if (likely(!tagged))
575b90356ceSToshiaki Makita 			/* Untagged Frame. */
5766dada9b1SNikolay Aleksandrov 			__vlan_hwaccel_put_tag(skb, br->vlan_proto, pvid);
577b90356ceSToshiaki Makita 		else
578b90356ceSToshiaki Makita 			/* Priority-tagged Frame.
5795978f8a9SMichał Mirosław 			 * At this point, we know that skb->vlan_tci VID
5805978f8a9SMichał Mirosław 			 * field was 0.
581b90356ceSToshiaki Makita 			 * We update only VID field and preserve PCP field.
582b90356ceSToshiaki Makita 			 */
583b90356ceSToshiaki Makita 			skb->vlan_tci |= pvid;
584b90356ceSToshiaki Makita 
585f4b7002aSNikolay Aleksandrov 		/* if snooping and stats are disabled we can avoid the lookup */
586f4b7002aSNikolay Aleksandrov 		if (!br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED) &&
587f4b7002aSNikolay Aleksandrov 		    !br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) {
588a580c76dSNikolay Aleksandrov 			if (*state == BR_STATE_FORWARDING) {
589a580c76dSNikolay Aleksandrov 				*state = br_vlan_get_pvid_state(vg);
590fd20d973STim Yi 				if (!br_vlan_state_allowed(*state, true))
591fd20d973STim Yi 					goto drop;
59278851988SVlad Yasevich 			}
593fd20d973STim Yi 			return true;
594a580c76dSNikolay Aleksandrov 		}
595a580c76dSNikolay Aleksandrov 	}
59677751ee8SNikolay Aleksandrov 	v = br_vlan_find(vg, *vid);
5976dada9b1SNikolay Aleksandrov 	if (!v || !br_vlan_should_use(v))
5986dada9b1SNikolay Aleksandrov 		goto drop;
5996dada9b1SNikolay Aleksandrov 
600a580c76dSNikolay Aleksandrov 	if (*state == BR_STATE_FORWARDING) {
601a580c76dSNikolay Aleksandrov 		*state = br_vlan_get_state(v);
602a580c76dSNikolay Aleksandrov 		if (!br_vlan_state_allowed(*state, true))
603a580c76dSNikolay Aleksandrov 			goto drop;
604a580c76dSNikolay Aleksandrov 	}
605a580c76dSNikolay Aleksandrov 
606ae75767eSNikolay Aleksandrov 	if (br_opt_get(br, BROPT_VLAN_STATS_ENABLED)) {
6076dada9b1SNikolay Aleksandrov 		stats = this_cpu_ptr(v->stats);
6086dada9b1SNikolay Aleksandrov 		u64_stats_update_begin(&stats->syncp);
6096dada9b1SNikolay Aleksandrov 		stats->rx_bytes += skb->len;
6106dada9b1SNikolay Aleksandrov 		stats->rx_packets++;
6116dada9b1SNikolay Aleksandrov 		u64_stats_update_end(&stats->syncp);
6126dada9b1SNikolay Aleksandrov 	}
6136dada9b1SNikolay Aleksandrov 
614f4b7002aSNikolay Aleksandrov 	*vlan = v;
615f4b7002aSNikolay Aleksandrov 
616a37b85c9SVlad Yasevich 	return true;
6176dada9b1SNikolay Aleksandrov 
618eb707618SToshiaki Makita drop:
619eb707618SToshiaki Makita 	kfree_skb(skb);
620a37b85c9SVlad Yasevich 	return false;
621a37b85c9SVlad Yasevich }
622a37b85c9SVlad Yasevich 
62377751ee8SNikolay Aleksandrov bool br_allowed_ingress(const struct net_bridge *br,
62477751ee8SNikolay Aleksandrov 			struct net_bridge_vlan_group *vg, struct sk_buff *skb,
625f4b7002aSNikolay Aleksandrov 			u16 *vid, u8 *state,
626f4b7002aSNikolay Aleksandrov 			struct net_bridge_vlan **vlan)
6272594e906SNikolay Aleksandrov {
6282594e906SNikolay Aleksandrov 	/* If VLAN filtering is disabled on the bridge, all packets are
6292594e906SNikolay Aleksandrov 	 * permitted.
6302594e906SNikolay Aleksandrov 	 */
631f4b7002aSNikolay Aleksandrov 	*vlan = NULL;
632ae75767eSNikolay Aleksandrov 	if (!br_opt_get(br, BROPT_VLAN_ENABLED)) {
6332594e906SNikolay Aleksandrov 		BR_INPUT_SKB_CB(skb)->vlan_filtered = false;
6342594e906SNikolay Aleksandrov 		return true;
6352594e906SNikolay Aleksandrov 	}
6362594e906SNikolay Aleksandrov 
637f4b7002aSNikolay Aleksandrov 	return __allowed_ingress(br, vg, skb, vid, state, vlan);
6382594e906SNikolay Aleksandrov }
6392594e906SNikolay Aleksandrov 
64085f46c6bSVlad Yasevich /* Called under RCU. */
6412594e906SNikolay Aleksandrov bool br_allowed_egress(struct net_bridge_vlan_group *vg,
64285f46c6bSVlad Yasevich 		       const struct sk_buff *skb)
64385f46c6bSVlad Yasevich {
6442594e906SNikolay Aleksandrov 	const struct net_bridge_vlan *v;
64585f46c6bSVlad Yasevich 	u16 vid;
64685f46c6bSVlad Yasevich 
64720adfa1aSVlad Yasevich 	/* If this packet was not filtered at input, let it pass */
64820adfa1aSVlad Yasevich 	if (!BR_INPUT_SKB_CB(skb)->vlan_filtered)
64985f46c6bSVlad Yasevich 		return true;
65085f46c6bSVlad Yasevich 
65185f46c6bSVlad Yasevich 	br_vlan_get_tag(skb, &vid);
6522594e906SNikolay Aleksandrov 	v = br_vlan_find(vg, vid);
653a580c76dSNikolay Aleksandrov 	if (v && br_vlan_should_use(v) &&
654a580c76dSNikolay Aleksandrov 	    br_vlan_state_allowed(br_vlan_get_state(v), false))
65585f46c6bSVlad Yasevich 		return true;
65685f46c6bSVlad Yasevich 
65785f46c6bSVlad Yasevich 	return false;
65885f46c6bSVlad Yasevich }
65985f46c6bSVlad Yasevich 
660e0d7968aSToshiaki Makita /* Called under RCU */
661e0d7968aSToshiaki Makita bool br_should_learn(struct net_bridge_port *p, struct sk_buff *skb, u16 *vid)
662e0d7968aSToshiaki Makita {
663468e7944SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
664e0d7968aSToshiaki Makita 	struct net_bridge *br = p->br;
665a580c76dSNikolay Aleksandrov 	struct net_bridge_vlan *v;
666e0d7968aSToshiaki Makita 
66720adfa1aSVlad Yasevich 	/* If filtering was disabled at input, let it pass. */
668ae75767eSNikolay Aleksandrov 	if (!br_opt_get(br, BROPT_VLAN_ENABLED))
669e0d7968aSToshiaki Makita 		return true;
670e0d7968aSToshiaki Makita 
671eca1e006SIdo Schimmel 	vg = nbp_vlan_group_rcu(p);
672468e7944SNikolay Aleksandrov 	if (!vg || !vg->num_vlans)
673e0d7968aSToshiaki Makita 		return false;
674e0d7968aSToshiaki Makita 
6758580e211SToshiaki Makita 	if (!br_vlan_get_tag(skb, vid) && skb->vlan_proto != br->vlan_proto)
6768580e211SToshiaki Makita 		*vid = 0;
6778580e211SToshiaki Makita 
678e0d7968aSToshiaki Makita 	if (!*vid) {
67977751ee8SNikolay Aleksandrov 		*vid = br_get_pvid(vg);
680a580c76dSNikolay Aleksandrov 		if (!*vid ||
681a580c76dSNikolay Aleksandrov 		    !br_vlan_state_allowed(br_vlan_get_pvid_state(vg), true))
682e0d7968aSToshiaki Makita 			return false;
683e0d7968aSToshiaki Makita 
684e0d7968aSToshiaki Makita 		return true;
685e0d7968aSToshiaki Makita 	}
686e0d7968aSToshiaki Makita 
687a580c76dSNikolay Aleksandrov 	v = br_vlan_find(vg, *vid);
688a580c76dSNikolay Aleksandrov 	if (v && br_vlan_state_allowed(br_vlan_get_state(v), true))
689e0d7968aSToshiaki Makita 		return true;
690e0d7968aSToshiaki Makita 
691e0d7968aSToshiaki Makita 	return false;
692e0d7968aSToshiaki Makita }
693e0d7968aSToshiaki Makita 
694dbd6dc75SPetr Machata static int br_vlan_add_existing(struct net_bridge *br,
695dbd6dc75SPetr Machata 				struct net_bridge_vlan_group *vg,
696dbd6dc75SPetr Machata 				struct net_bridge_vlan *vlan,
697169327d5SPetr Machata 				u16 flags, bool *changed,
698169327d5SPetr Machata 				struct netlink_ext_ack *extack)
699dbd6dc75SPetr Machata {
700*27c5f74cSVladimir Oltean 	bool would_change = __vlan_flags_would_change(vlan, flags);
701*27c5f74cSVladimir Oltean 	bool becomes_brentry = false;
702dbd6dc75SPetr Machata 	int err;
703dbd6dc75SPetr Machata 
704*27c5f74cSVladimir Oltean 	if (!br_vlan_is_brentry(vlan)) {
705b2bc58d4SVladimir Oltean 		/* Trying to change flags of non-existent bridge vlan */
706*27c5f74cSVladimir Oltean 		if (!(flags & BRIDGE_VLAN_INFO_BRENTRY))
707b2bc58d4SVladimir Oltean 			return -EINVAL;
708b2bc58d4SVladimir Oltean 
709*27c5f74cSVladimir Oltean 		becomes_brentry = true;
710*27c5f74cSVladimir Oltean 	}
711*27c5f74cSVladimir Oltean 
712*27c5f74cSVladimir Oltean 	/* Master VLANs that aren't brentries weren't notified before,
713*27c5f74cSVladimir Oltean 	 * time to notify them now.
714*27c5f74cSVladimir Oltean 	 */
715*27c5f74cSVladimir Oltean 	if (becomes_brentry || would_change) {
716*27c5f74cSVladimir Oltean 		err = br_switchdev_port_vlan_add(br->dev, vlan->vid, flags,
717*27c5f74cSVladimir Oltean 						 extack);
7189c86ce2cSPetr Machata 		if (err && err != -EOPNOTSUPP)
7199c86ce2cSPetr Machata 			return err;
720*27c5f74cSVladimir Oltean 	}
7219c86ce2cSPetr Machata 
722*27c5f74cSVladimir Oltean 	if (becomes_brentry) {
723dbd6dc75SPetr Machata 		/* It was only kept for port vlans, now make it real */
724f6814fdcSVladimir Oltean 		err = br_fdb_add_local(br, NULL, br->dev->dev_addr, vlan->vid);
725dbd6dc75SPetr Machata 		if (err) {
726dbd6dc75SPetr Machata 			br_err(br, "failed to insert local address into bridge forwarding table\n");
7279c86ce2cSPetr Machata 			goto err_fdb_insert;
728dbd6dc75SPetr Machata 		}
729dbd6dc75SPetr Machata 
730dbd6dc75SPetr Machata 		refcount_inc(&vlan->refcnt);
731dbd6dc75SPetr Machata 		vlan->flags |= BRIDGE_VLAN_INFO_BRENTRY;
732dbd6dc75SPetr Machata 		vg->num_vlans++;
733dbd6dc75SPetr Machata 		*changed = true;
734b92dace3SNikolay Aleksandrov 		br_multicast_toggle_one_vlan(vlan, true);
735dbd6dc75SPetr Machata 	}
736dbd6dc75SPetr Machata 
737*27c5f74cSVladimir Oltean 	__vlan_flags_commit(vlan, flags);
738*27c5f74cSVladimir Oltean 	if (would_change)
739dbd6dc75SPetr Machata 		*changed = true;
740dbd6dc75SPetr Machata 
741dbd6dc75SPetr Machata 	return 0;
7429c86ce2cSPetr Machata 
7439c86ce2cSPetr Machata err_fdb_insert:
7449c86ce2cSPetr Machata 	br_switchdev_port_vlan_del(br->dev, vlan->vid);
7459c86ce2cSPetr Machata 	return err;
746dbd6dc75SPetr Machata }
747dbd6dc75SPetr Machata 
7488adff41cSToshiaki Makita /* Must be protected by RTNL.
7498adff41cSToshiaki Makita  * Must be called with vid in range from 1 to 4094 inclusive.
750f418af63SNikolay Aleksandrov  * changed must be true only if the vlan was created or updated
7518adff41cSToshiaki Makita  */
752169327d5SPetr Machata int br_vlan_add(struct net_bridge *br, u16 vid, u16 flags, bool *changed,
753169327d5SPetr Machata 		struct netlink_ext_ack *extack)
754243a2e63SVlad Yasevich {
755907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
7562594e906SNikolay Aleksandrov 	struct net_bridge_vlan *vlan;
7572594e906SNikolay Aleksandrov 	int ret;
758243a2e63SVlad Yasevich 
759243a2e63SVlad Yasevich 	ASSERT_RTNL();
760243a2e63SVlad Yasevich 
761f418af63SNikolay Aleksandrov 	*changed = false;
762907b1e6eSNikolay Aleksandrov 	vg = br_vlan_group(br);
763907b1e6eSNikolay Aleksandrov 	vlan = br_vlan_find(vg, vid);
764dbd6dc75SPetr Machata 	if (vlan)
765169327d5SPetr Machata 		return br_vlan_add_existing(br, vg, vlan, flags, changed,
766169327d5SPetr Machata 					    extack);
767243a2e63SVlad Yasevich 
7682594e906SNikolay Aleksandrov 	vlan = kzalloc(sizeof(*vlan), GFP_KERNEL);
7692594e906SNikolay Aleksandrov 	if (!vlan)
770243a2e63SVlad Yasevich 		return -ENOMEM;
771243a2e63SVlad Yasevich 
772281cc284SHeiner Kallweit 	vlan->stats = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
7736dada9b1SNikolay Aleksandrov 	if (!vlan->stats) {
7746dada9b1SNikolay Aleksandrov 		kfree(vlan);
7756dada9b1SNikolay Aleksandrov 		return -ENOMEM;
7766dada9b1SNikolay Aleksandrov 	}
7772594e906SNikolay Aleksandrov 	vlan->vid = vid;
7782594e906SNikolay Aleksandrov 	vlan->flags = flags | BRIDGE_VLAN_INFO_MASTER;
7792594e906SNikolay Aleksandrov 	vlan->flags &= ~BRIDGE_VLAN_INFO_PVID;
7802594e906SNikolay Aleksandrov 	vlan->br = br;
7812594e906SNikolay Aleksandrov 	if (flags & BRIDGE_VLAN_INFO_BRENTRY)
78225127759SReshetova, Elena 		refcount_set(&vlan->refcnt, 1);
783169327d5SPetr Machata 	ret = __vlan_add(vlan, flags, extack);
7846dada9b1SNikolay Aleksandrov 	if (ret) {
7856dada9b1SNikolay Aleksandrov 		free_percpu(vlan->stats);
7862594e906SNikolay Aleksandrov 		kfree(vlan);
787f418af63SNikolay Aleksandrov 	} else {
788f418af63SNikolay Aleksandrov 		*changed = true;
7896dada9b1SNikolay Aleksandrov 	}
790243a2e63SVlad Yasevich 
7912594e906SNikolay Aleksandrov 	return ret;
792243a2e63SVlad Yasevich }
793243a2e63SVlad Yasevich 
7948adff41cSToshiaki Makita /* Must be protected by RTNL.
7958adff41cSToshiaki Makita  * Must be called with vid in range from 1 to 4094 inclusive.
7968adff41cSToshiaki Makita  */
797243a2e63SVlad Yasevich int br_vlan_delete(struct net_bridge *br, u16 vid)
798243a2e63SVlad Yasevich {
799907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
8002594e906SNikolay Aleksandrov 	struct net_bridge_vlan *v;
801243a2e63SVlad Yasevich 
802243a2e63SVlad Yasevich 	ASSERT_RTNL();
803243a2e63SVlad Yasevich 
804907b1e6eSNikolay Aleksandrov 	vg = br_vlan_group(br);
805907b1e6eSNikolay Aleksandrov 	v = br_vlan_find(vg, vid);
8062594e906SNikolay Aleksandrov 	if (!v || !br_vlan_is_brentry(v))
8072594e906SNikolay Aleksandrov 		return -ENOENT;
808243a2e63SVlad Yasevich 
809424bb9c9SToshiaki Makita 	br_fdb_find_delete_local(br, NULL, br->dev->dev_addr, vid);
8103741873bSRoopa Prabhu 	br_fdb_delete_by_port(br, NULL, vid, 0);
811bc9a25d2SVlad Yasevich 
812efa5356bSRoopa Prabhu 	vlan_tunnel_info_del(vg, v);
813efa5356bSRoopa Prabhu 
8142594e906SNikolay Aleksandrov 	return __vlan_del(v);
815243a2e63SVlad Yasevich }
816243a2e63SVlad Yasevich 
817243a2e63SVlad Yasevich void br_vlan_flush(struct net_bridge *br)
818243a2e63SVlad Yasevich {
819f409d0edSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
820f409d0edSNikolay Aleksandrov 
821243a2e63SVlad Yasevich 	ASSERT_RTNL();
822243a2e63SVlad Yasevich 
823f409d0edSNikolay Aleksandrov 	vg = br_vlan_group(br);
824f545923bSNikolay Aleksandrov 	__vlan_flush(br, NULL, vg);
825f409d0edSNikolay Aleksandrov 	RCU_INIT_POINTER(br->vlgrp, NULL);
826f409d0edSNikolay Aleksandrov 	synchronize_rcu();
827f409d0edSNikolay Aleksandrov 	__vlan_group_free(vg);
828243a2e63SVlad Yasevich }
829243a2e63SVlad Yasevich 
8302594e906SNikolay Aleksandrov struct net_bridge_vlan *br_vlan_find(struct net_bridge_vlan_group *vg, u16 vid)
8312b292fb4SToshiaki Makita {
8322594e906SNikolay Aleksandrov 	if (!vg)
8332594e906SNikolay Aleksandrov 		return NULL;
8342b292fb4SToshiaki Makita 
8352594e906SNikolay Aleksandrov 	return br_vlan_lookup(&vg->vlan_hash, vid);
8362b292fb4SToshiaki Makita }
8372b292fb4SToshiaki Makita 
838204177f3SToshiaki Makita /* Must be protected by RTNL. */
839204177f3SToshiaki Makita static void recalculate_group_addr(struct net_bridge *br)
840204177f3SToshiaki Makita {
841be3664a0SNikolay Aleksandrov 	if (br_opt_get(br, BROPT_GROUP_ADDR_SET))
842204177f3SToshiaki Makita 		return;
843204177f3SToshiaki Makita 
844204177f3SToshiaki Makita 	spin_lock_bh(&br->lock);
845ae75767eSNikolay Aleksandrov 	if (!br_opt_get(br, BROPT_VLAN_ENABLED) ||
846ae75767eSNikolay Aleksandrov 	    br->vlan_proto == htons(ETH_P_8021Q)) {
847204177f3SToshiaki Makita 		/* Bridge Group Address */
848204177f3SToshiaki Makita 		br->group_addr[5] = 0x00;
849204177f3SToshiaki Makita 	} else { /* vlan_enabled && ETH_P_8021AD */
850204177f3SToshiaki Makita 		/* Provider Bridge Group Address */
851204177f3SToshiaki Makita 		br->group_addr[5] = 0x08;
852204177f3SToshiaki Makita 	}
853204177f3SToshiaki Makita 	spin_unlock_bh(&br->lock);
854204177f3SToshiaki Makita }
855204177f3SToshiaki Makita 
856204177f3SToshiaki Makita /* Must be protected by RTNL. */
857204177f3SToshiaki Makita void br_recalculate_fwd_mask(struct net_bridge *br)
858204177f3SToshiaki Makita {
859ae75767eSNikolay Aleksandrov 	if (!br_opt_get(br, BROPT_VLAN_ENABLED) ||
860ae75767eSNikolay Aleksandrov 	    br->vlan_proto == htons(ETH_P_8021Q))
861204177f3SToshiaki Makita 		br->group_fwd_mask_required = BR_GROUPFWD_DEFAULT;
862204177f3SToshiaki Makita 	else /* vlan_enabled && ETH_P_8021AD */
863204177f3SToshiaki Makita 		br->group_fwd_mask_required = BR_GROUPFWD_8021AD &
864204177f3SToshiaki Makita 					      ~(1u << br->group_addr[5]);
865204177f3SToshiaki Makita }
866204177f3SToshiaki Makita 
8679e781401SVladimir Oltean int br_vlan_filter_toggle(struct net_bridge *br, unsigned long val,
8689e781401SVladimir Oltean 			  struct netlink_ext_ack *extack)
869243a2e63SVlad Yasevich {
8706b72a770SElad Raz 	struct switchdev_attr attr = {
8716b72a770SElad Raz 		.orig_dev = br->dev,
8726b72a770SElad Raz 		.id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING,
8736b72a770SElad Raz 		.flags = SWITCHDEV_F_SKIP_EOPNOTSUPP,
8746b72a770SElad Raz 		.u.vlan_filtering = val,
8756b72a770SElad Raz 	};
8766b72a770SElad Raz 	int err;
8776b72a770SElad Raz 
878ae75767eSNikolay Aleksandrov 	if (br_opt_get(br, BROPT_VLAN_ENABLED) == !!val)
879a7854037SNikolay Aleksandrov 		return 0;
880243a2e63SVlad Yasevich 
881ae75767eSNikolay Aleksandrov 	br_opt_toggle(br, BROPT_VLAN_ENABLED, !!val);
882f7cdb3ecSVladimir Oltean 
883f7cdb3ecSVladimir Oltean 	err = switchdev_port_attr_set(br->dev, &attr, extack);
884f7cdb3ecSVladimir Oltean 	if (err && err != -EOPNOTSUPP) {
885f7cdb3ecSVladimir Oltean 		br_opt_toggle(br, BROPT_VLAN_ENABLED, !val);
886f7cdb3ecSVladimir Oltean 		return err;
887f7cdb3ecSVladimir Oltean 	}
888f7cdb3ecSVladimir Oltean 
8892796d0c6SVlad Yasevich 	br_manage_promisc(br);
890204177f3SToshiaki Makita 	recalculate_group_addr(br);
891204177f3SToshiaki Makita 	br_recalculate_fwd_mask(br);
892f4b7002aSNikolay Aleksandrov 	if (!val && br_opt_get(br, BROPT_MCAST_VLAN_SNOOPING_ENABLED)) {
893f4b7002aSNikolay Aleksandrov 		br_info(br, "vlan filtering disabled, automatically disabling multicast vlan snooping\n");
894f4b7002aSNikolay Aleksandrov 		br_multicast_toggle_vlan_snooping(br, false, NULL);
895f4b7002aSNikolay Aleksandrov 	}
896243a2e63SVlad Yasevich 
897a7854037SNikolay Aleksandrov 	return 0;
898a7854037SNikolay Aleksandrov }
899a7854037SNikolay Aleksandrov 
9001f51445aSIdo Schimmel bool br_vlan_enabled(const struct net_device *dev)
9011f51445aSIdo Schimmel {
9021f51445aSIdo Schimmel 	struct net_bridge *br = netdev_priv(dev);
9031f51445aSIdo Schimmel 
904ae75767eSNikolay Aleksandrov 	return br_opt_get(br, BROPT_VLAN_ENABLED);
9051f51445aSIdo Schimmel }
9061f51445aSIdo Schimmel EXPORT_SYMBOL_GPL(br_vlan_enabled);
9071f51445aSIdo Schimmel 
90831aed46fSwenxu int br_vlan_get_proto(const struct net_device *dev, u16 *p_proto)
90931aed46fSwenxu {
91031aed46fSwenxu 	struct net_bridge *br = netdev_priv(dev);
91131aed46fSwenxu 
91231aed46fSwenxu 	*p_proto = ntohs(br->vlan_proto);
91331aed46fSwenxu 
91431aed46fSwenxu 	return 0;
91531aed46fSwenxu }
91631aed46fSwenxu EXPORT_SYMBOL_GPL(br_vlan_get_proto);
91731aed46fSwenxu 
918dcbdf135SVladimir Oltean int __br_vlan_set_proto(struct net_bridge *br, __be16 proto,
919dcbdf135SVladimir Oltean 			struct netlink_ext_ack *extack)
920204177f3SToshiaki Makita {
92122ec19f3SDanielle Ratson 	struct switchdev_attr attr = {
92222ec19f3SDanielle Ratson 		.orig_dev = br->dev,
92322ec19f3SDanielle Ratson 		.id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_PROTOCOL,
92422ec19f3SDanielle Ratson 		.flags = SWITCHDEV_F_SKIP_EOPNOTSUPP,
92522ec19f3SDanielle Ratson 		.u.vlan_protocol = ntohs(proto),
92622ec19f3SDanielle Ratson 	};
927204177f3SToshiaki Makita 	int err = 0;
928204177f3SToshiaki Makita 	struct net_bridge_port *p;
9292594e906SNikolay Aleksandrov 	struct net_bridge_vlan *vlan;
930907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
93122ec19f3SDanielle Ratson 	__be16 oldproto = br->vlan_proto;
932204177f3SToshiaki Makita 
933204177f3SToshiaki Makita 	if (br->vlan_proto == proto)
934d2d427b3SToshiaki Makita 		return 0;
935204177f3SToshiaki Makita 
936dcbdf135SVladimir Oltean 	err = switchdev_port_attr_set(br->dev, &attr, extack);
93722ec19f3SDanielle Ratson 	if (err && err != -EOPNOTSUPP)
93822ec19f3SDanielle Ratson 		return err;
93922ec19f3SDanielle Ratson 
940204177f3SToshiaki Makita 	/* Add VLANs for the new proto to the device filter. */
941204177f3SToshiaki Makita 	list_for_each_entry(p, &br->port_list, list) {
942907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(p);
943907b1e6eSNikolay Aleksandrov 		list_for_each_entry(vlan, &vg->vlan_list, vlist) {
9442594e906SNikolay Aleksandrov 			err = vlan_vid_add(p->dev, proto, vlan->vid);
945204177f3SToshiaki Makita 			if (err)
946204177f3SToshiaki Makita 				goto err_filt;
947204177f3SToshiaki Makita 		}
948204177f3SToshiaki Makita 	}
949204177f3SToshiaki Makita 
950204177f3SToshiaki Makita 	br->vlan_proto = proto;
951204177f3SToshiaki Makita 
952204177f3SToshiaki Makita 	recalculate_group_addr(br);
953204177f3SToshiaki Makita 	br_recalculate_fwd_mask(br);
954204177f3SToshiaki Makita 
955204177f3SToshiaki Makita 	/* Delete VLANs for the old proto from the device filter. */
956907b1e6eSNikolay Aleksandrov 	list_for_each_entry(p, &br->port_list, list) {
957907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(p);
958907b1e6eSNikolay Aleksandrov 		list_for_each_entry(vlan, &vg->vlan_list, vlist)
9592594e906SNikolay Aleksandrov 			vlan_vid_del(p->dev, oldproto, vlan->vid);
960907b1e6eSNikolay Aleksandrov 	}
961204177f3SToshiaki Makita 
962d2d427b3SToshiaki Makita 	return 0;
963204177f3SToshiaki Makita 
964204177f3SToshiaki Makita err_filt:
96522ec19f3SDanielle Ratson 	attr.u.vlan_protocol = ntohs(oldproto);
966dcbdf135SVladimir Oltean 	switchdev_port_attr_set(br->dev, &attr, NULL);
96722ec19f3SDanielle Ratson 
968907b1e6eSNikolay Aleksandrov 	list_for_each_entry_continue_reverse(vlan, &vg->vlan_list, vlist)
9692594e906SNikolay Aleksandrov 		vlan_vid_del(p->dev, proto, vlan->vid);
970204177f3SToshiaki Makita 
971907b1e6eSNikolay Aleksandrov 	list_for_each_entry_continue_reverse(p, &br->port_list, list) {
972907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(p);
973907b1e6eSNikolay Aleksandrov 		list_for_each_entry(vlan, &vg->vlan_list, vlist)
9742594e906SNikolay Aleksandrov 			vlan_vid_del(p->dev, proto, vlan->vid);
975907b1e6eSNikolay Aleksandrov 	}
976204177f3SToshiaki Makita 
977d2d427b3SToshiaki Makita 	return err;
978d2d427b3SToshiaki Makita }
979d2d427b3SToshiaki Makita 
9809e781401SVladimir Oltean int br_vlan_set_proto(struct net_bridge *br, unsigned long val,
9819e781401SVladimir Oltean 		      struct netlink_ext_ack *extack)
982d2d427b3SToshiaki Makita {
983a98c0c47SMenglong Dong 	if (!eth_type_vlan(htons(val)))
984d2d427b3SToshiaki Makita 		return -EPROTONOSUPPORT;
985d2d427b3SToshiaki Makita 
986dcbdf135SVladimir Oltean 	return __br_vlan_set_proto(br, htons(val), extack);
987204177f3SToshiaki Makita }
988204177f3SToshiaki Makita 
9896dada9b1SNikolay Aleksandrov int br_vlan_set_stats(struct net_bridge *br, unsigned long val)
9906dada9b1SNikolay Aleksandrov {
9916dada9b1SNikolay Aleksandrov 	switch (val) {
9926dada9b1SNikolay Aleksandrov 	case 0:
9936dada9b1SNikolay Aleksandrov 	case 1:
994ae75767eSNikolay Aleksandrov 		br_opt_toggle(br, BROPT_VLAN_STATS_ENABLED, !!val);
9956dada9b1SNikolay Aleksandrov 		break;
9966dada9b1SNikolay Aleksandrov 	default:
9976dada9b1SNikolay Aleksandrov 		return -EINVAL;
9986dada9b1SNikolay Aleksandrov 	}
9996dada9b1SNikolay Aleksandrov 
10006dada9b1SNikolay Aleksandrov 	return 0;
10016dada9b1SNikolay Aleksandrov }
10026dada9b1SNikolay Aleksandrov 
10039163a0fcSNikolay Aleksandrov int br_vlan_set_stats_per_port(struct net_bridge *br, unsigned long val)
10049163a0fcSNikolay Aleksandrov {
10059163a0fcSNikolay Aleksandrov 	struct net_bridge_port *p;
10069163a0fcSNikolay Aleksandrov 
10079163a0fcSNikolay Aleksandrov 	/* allow to change the option if there are no port vlans configured */
10089163a0fcSNikolay Aleksandrov 	list_for_each_entry(p, &br->port_list, list) {
10099163a0fcSNikolay Aleksandrov 		struct net_bridge_vlan_group *vg = nbp_vlan_group(p);
10109163a0fcSNikolay Aleksandrov 
10119163a0fcSNikolay Aleksandrov 		if (vg->num_vlans)
10129163a0fcSNikolay Aleksandrov 			return -EBUSY;
10139163a0fcSNikolay Aleksandrov 	}
10149163a0fcSNikolay Aleksandrov 
10159163a0fcSNikolay Aleksandrov 	switch (val) {
10169163a0fcSNikolay Aleksandrov 	case 0:
10179163a0fcSNikolay Aleksandrov 	case 1:
10189163a0fcSNikolay Aleksandrov 		br_opt_toggle(br, BROPT_VLAN_STATS_PER_PORT, !!val);
10199163a0fcSNikolay Aleksandrov 		break;
10209163a0fcSNikolay Aleksandrov 	default:
10219163a0fcSNikolay Aleksandrov 		return -EINVAL;
10229163a0fcSNikolay Aleksandrov 	}
10239163a0fcSNikolay Aleksandrov 
10249163a0fcSNikolay Aleksandrov 	return 0;
10259163a0fcSNikolay Aleksandrov }
10269163a0fcSNikolay Aleksandrov 
102777751ee8SNikolay Aleksandrov static bool vlan_default_pvid(struct net_bridge_vlan_group *vg, u16 vid)
10285be5a2dfSVlad Yasevich {
10292594e906SNikolay Aleksandrov 	struct net_bridge_vlan *v;
10302594e906SNikolay Aleksandrov 
103177751ee8SNikolay Aleksandrov 	if (vid != vg->pvid)
10322594e906SNikolay Aleksandrov 		return false;
10332594e906SNikolay Aleksandrov 
10342594e906SNikolay Aleksandrov 	v = br_vlan_lookup(&vg->vlan_hash, vid);
10352594e906SNikolay Aleksandrov 	if (v && br_vlan_should_use(v) &&
10362594e906SNikolay Aleksandrov 	    (v->flags & BRIDGE_VLAN_INFO_UNTAGGED))
10372594e906SNikolay Aleksandrov 		return true;
10382594e906SNikolay Aleksandrov 
10392594e906SNikolay Aleksandrov 	return false;
10405be5a2dfSVlad Yasevich }
10415be5a2dfSVlad Yasevich 
10425be5a2dfSVlad Yasevich static void br_vlan_disable_default_pvid(struct net_bridge *br)
10435be5a2dfSVlad Yasevich {
10445be5a2dfSVlad Yasevich 	struct net_bridge_port *p;
10455be5a2dfSVlad Yasevich 	u16 pvid = br->default_pvid;
10465be5a2dfSVlad Yasevich 
10475be5a2dfSVlad Yasevich 	/* Disable default_pvid on all ports where it is still
10485be5a2dfSVlad Yasevich 	 * configured.
10495be5a2dfSVlad Yasevich 	 */
1050f545923bSNikolay Aleksandrov 	if (vlan_default_pvid(br_vlan_group(br), pvid)) {
1051f545923bSNikolay Aleksandrov 		if (!br_vlan_delete(br, pvid))
1052f545923bSNikolay Aleksandrov 			br_vlan_notify(br, NULL, pvid, 0, RTM_DELVLAN);
1053f545923bSNikolay Aleksandrov 	}
10545be5a2dfSVlad Yasevich 
10555be5a2dfSVlad Yasevich 	list_for_each_entry(p, &br->port_list, list) {
1056f545923bSNikolay Aleksandrov 		if (vlan_default_pvid(nbp_vlan_group(p), pvid) &&
1057f545923bSNikolay Aleksandrov 		    !nbp_vlan_delete(p, pvid))
1058f545923bSNikolay Aleksandrov 			br_vlan_notify(br, p, pvid, 0, RTM_DELVLAN);
10595be5a2dfSVlad Yasevich 	}
10605be5a2dfSVlad Yasevich 
10615be5a2dfSVlad Yasevich 	br->default_pvid = 0;
10625be5a2dfSVlad Yasevich }
10635be5a2dfSVlad Yasevich 
1064169327d5SPetr Machata int __br_vlan_set_default_pvid(struct net_bridge *br, u16 pvid,
1065169327d5SPetr Machata 			       struct netlink_ext_ack *extack)
10665be5a2dfSVlad Yasevich {
10672594e906SNikolay Aleksandrov 	const struct net_bridge_vlan *pvent;
1068907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
10695be5a2dfSVlad Yasevich 	struct net_bridge_port *p;
1070f418af63SNikolay Aleksandrov 	unsigned long *changed;
1071f418af63SNikolay Aleksandrov 	bool vlchange;
10725be5a2dfSVlad Yasevich 	u16 old_pvid;
10735be5a2dfSVlad Yasevich 	int err = 0;
10745be5a2dfSVlad Yasevich 
10750f963b75SNikolay Aleksandrov 	if (!pvid) {
10760f963b75SNikolay Aleksandrov 		br_vlan_disable_default_pvid(br);
10770f963b75SNikolay Aleksandrov 		return 0;
10780f963b75SNikolay Aleksandrov 	}
10790f963b75SNikolay Aleksandrov 
1080459479daSAndy Shevchenko 	changed = bitmap_zalloc(BR_MAX_PORTS, GFP_KERNEL);
10815be5a2dfSVlad Yasevich 	if (!changed)
10825be5a2dfSVlad Yasevich 		return -ENOMEM;
10835be5a2dfSVlad Yasevich 
10845be5a2dfSVlad Yasevich 	old_pvid = br->default_pvid;
10855be5a2dfSVlad Yasevich 
10865be5a2dfSVlad Yasevich 	/* Update default_pvid config only if we do not conflict with
10875be5a2dfSVlad Yasevich 	 * user configuration.
10885be5a2dfSVlad Yasevich 	 */
1089907b1e6eSNikolay Aleksandrov 	vg = br_vlan_group(br);
1090907b1e6eSNikolay Aleksandrov 	pvent = br_vlan_find(vg, pvid);
1091907b1e6eSNikolay Aleksandrov 	if ((!old_pvid || vlan_default_pvid(vg, old_pvid)) &&
10922594e906SNikolay Aleksandrov 	    (!pvent || !br_vlan_should_use(pvent))) {
10935be5a2dfSVlad Yasevich 		err = br_vlan_add(br, pvid,
10945be5a2dfSVlad Yasevich 				  BRIDGE_VLAN_INFO_PVID |
10952594e906SNikolay Aleksandrov 				  BRIDGE_VLAN_INFO_UNTAGGED |
1096f418af63SNikolay Aleksandrov 				  BRIDGE_VLAN_INFO_BRENTRY,
1097169327d5SPetr Machata 				  &vlchange, extack);
10985be5a2dfSVlad Yasevich 		if (err)
10995be5a2dfSVlad Yasevich 			goto out;
1100f545923bSNikolay Aleksandrov 
1101f545923bSNikolay Aleksandrov 		if (br_vlan_delete(br, old_pvid))
1102f545923bSNikolay Aleksandrov 			br_vlan_notify(br, NULL, old_pvid, 0, RTM_DELVLAN);
1103f545923bSNikolay Aleksandrov 		br_vlan_notify(br, NULL, pvid, 0, RTM_NEWVLAN);
1104442b03c3SXin Long 		__set_bit(0, changed);
11055be5a2dfSVlad Yasevich 	}
11065be5a2dfSVlad Yasevich 
11075be5a2dfSVlad Yasevich 	list_for_each_entry(p, &br->port_list, list) {
11085be5a2dfSVlad Yasevich 		/* Update default_pvid config only if we do not conflict with
11095be5a2dfSVlad Yasevich 		 * user configuration.
11105be5a2dfSVlad Yasevich 		 */
1111907b1e6eSNikolay Aleksandrov 		vg = nbp_vlan_group(p);
11125be5a2dfSVlad Yasevich 		if ((old_pvid &&
1113907b1e6eSNikolay Aleksandrov 		     !vlan_default_pvid(vg, old_pvid)) ||
1114907b1e6eSNikolay Aleksandrov 		    br_vlan_find(vg, pvid))
11155be5a2dfSVlad Yasevich 			continue;
11165be5a2dfSVlad Yasevich 
11175be5a2dfSVlad Yasevich 		err = nbp_vlan_add(p, pvid,
11185be5a2dfSVlad Yasevich 				   BRIDGE_VLAN_INFO_PVID |
1119f418af63SNikolay Aleksandrov 				   BRIDGE_VLAN_INFO_UNTAGGED,
1120169327d5SPetr Machata 				   &vlchange, extack);
11215be5a2dfSVlad Yasevich 		if (err)
11225be5a2dfSVlad Yasevich 			goto err_port;
1123f545923bSNikolay Aleksandrov 		if (nbp_vlan_delete(p, old_pvid))
1124f545923bSNikolay Aleksandrov 			br_vlan_notify(br, p, old_pvid, 0, RTM_DELVLAN);
1125f545923bSNikolay Aleksandrov 		br_vlan_notify(p->br, p, pvid, 0, RTM_NEWVLAN);
1126442b03c3SXin Long 		__set_bit(p->port_no, changed);
11275be5a2dfSVlad Yasevich 	}
11285be5a2dfSVlad Yasevich 
11295be5a2dfSVlad Yasevich 	br->default_pvid = pvid;
11305be5a2dfSVlad Yasevich 
11315be5a2dfSVlad Yasevich out:
1132459479daSAndy Shevchenko 	bitmap_free(changed);
11335be5a2dfSVlad Yasevich 	return err;
11345be5a2dfSVlad Yasevich 
11355be5a2dfSVlad Yasevich err_port:
11365be5a2dfSVlad Yasevich 	list_for_each_entry_continue_reverse(p, &br->port_list, list) {
11375be5a2dfSVlad Yasevich 		if (!test_bit(p->port_no, changed))
11385be5a2dfSVlad Yasevich 			continue;
11395be5a2dfSVlad Yasevich 
1140f545923bSNikolay Aleksandrov 		if (old_pvid) {
11415be5a2dfSVlad Yasevich 			nbp_vlan_add(p, old_pvid,
11425be5a2dfSVlad Yasevich 				     BRIDGE_VLAN_INFO_PVID |
1143f418af63SNikolay Aleksandrov 				     BRIDGE_VLAN_INFO_UNTAGGED,
1144169327d5SPetr Machata 				     &vlchange, NULL);
1145f545923bSNikolay Aleksandrov 			br_vlan_notify(p->br, p, old_pvid, 0, RTM_NEWVLAN);
1146f545923bSNikolay Aleksandrov 		}
11475be5a2dfSVlad Yasevich 		nbp_vlan_delete(p, pvid);
1148f545923bSNikolay Aleksandrov 		br_vlan_notify(br, p, pvid, 0, RTM_DELVLAN);
11495be5a2dfSVlad Yasevich 	}
11505be5a2dfSVlad Yasevich 
11515be5a2dfSVlad Yasevich 	if (test_bit(0, changed)) {
1152f545923bSNikolay Aleksandrov 		if (old_pvid) {
11535be5a2dfSVlad Yasevich 			br_vlan_add(br, old_pvid,
11545be5a2dfSVlad Yasevich 				    BRIDGE_VLAN_INFO_PVID |
11552594e906SNikolay Aleksandrov 				    BRIDGE_VLAN_INFO_UNTAGGED |
1156f418af63SNikolay Aleksandrov 				    BRIDGE_VLAN_INFO_BRENTRY,
1157169327d5SPetr Machata 				    &vlchange, NULL);
1158f545923bSNikolay Aleksandrov 			br_vlan_notify(br, NULL, old_pvid, 0, RTM_NEWVLAN);
1159f545923bSNikolay Aleksandrov 		}
11605be5a2dfSVlad Yasevich 		br_vlan_delete(br, pvid);
1161f545923bSNikolay Aleksandrov 		br_vlan_notify(br, NULL, pvid, 0, RTM_DELVLAN);
11625be5a2dfSVlad Yasevich 	}
11635be5a2dfSVlad Yasevich 	goto out;
11645be5a2dfSVlad Yasevich }
11655be5a2dfSVlad Yasevich 
11669e781401SVladimir Oltean int br_vlan_set_default_pvid(struct net_bridge *br, unsigned long val,
11679e781401SVladimir Oltean 			     struct netlink_ext_ack *extack)
116896a20d9dSVlad Yasevich {
116996a20d9dSVlad Yasevich 	u16 pvid = val;
117096a20d9dSVlad Yasevich 	int err = 0;
117196a20d9dSVlad Yasevich 
11725be5a2dfSVlad Yasevich 	if (val >= VLAN_VID_MASK)
117396a20d9dSVlad Yasevich 		return -EINVAL;
117496a20d9dSVlad Yasevich 
117596a20d9dSVlad Yasevich 	if (pvid == br->default_pvid)
1176047831a9SXin Long 		goto out;
117796a20d9dSVlad Yasevich 
117896a20d9dSVlad Yasevich 	/* Only allow default pvid change when filtering is disabled */
1179ae75767eSNikolay Aleksandrov 	if (br_opt_get(br, BROPT_VLAN_ENABLED)) {
118096a20d9dSVlad Yasevich 		pr_info_once("Please disable vlan filtering to change default_pvid\n");
118196a20d9dSVlad Yasevich 		err = -EPERM;
1182047831a9SXin Long 		goto out;
118396a20d9dSVlad Yasevich 	}
11849e781401SVladimir Oltean 	err = __br_vlan_set_default_pvid(br, pvid, extack);
1185047831a9SXin Long out:
118696a20d9dSVlad Yasevich 	return err;
118796a20d9dSVlad Yasevich }
118896a20d9dSVlad Yasevich 
11895be5a2dfSVlad Yasevich int br_vlan_init(struct net_bridge *br)
11908580e211SToshiaki Makita {
1191907b1e6eSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
11922594e906SNikolay Aleksandrov 	int ret = -ENOMEM;
11932594e906SNikolay Aleksandrov 
1194907b1e6eSNikolay Aleksandrov 	vg = kzalloc(sizeof(*vg), GFP_KERNEL);
1195907b1e6eSNikolay Aleksandrov 	if (!vg)
11962594e906SNikolay Aleksandrov 		goto out;
1197907b1e6eSNikolay Aleksandrov 	ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params);
11982594e906SNikolay Aleksandrov 	if (ret)
11992594e906SNikolay Aleksandrov 		goto err_rhtbl;
1200efa5356bSRoopa Prabhu 	ret = vlan_tunnel_init(vg);
1201efa5356bSRoopa Prabhu 	if (ret)
1202efa5356bSRoopa Prabhu 		goto err_tunnel_init;
1203907b1e6eSNikolay Aleksandrov 	INIT_LIST_HEAD(&vg->vlan_list);
12048580e211SToshiaki Makita 	br->vlan_proto = htons(ETH_P_8021Q);
120596a20d9dSVlad Yasevich 	br->default_pvid = 1;
1206907b1e6eSNikolay Aleksandrov 	rcu_assign_pointer(br->vlgrp, vg);
12072594e906SNikolay Aleksandrov 
12082594e906SNikolay Aleksandrov out:
12092594e906SNikolay Aleksandrov 	return ret;
12102594e906SNikolay Aleksandrov 
1211efa5356bSRoopa Prabhu err_tunnel_init:
1212907b1e6eSNikolay Aleksandrov 	rhashtable_destroy(&vg->vlan_hash);
12132594e906SNikolay Aleksandrov err_rhtbl:
1214907b1e6eSNikolay Aleksandrov 	kfree(vg);
12152594e906SNikolay Aleksandrov 
12162594e906SNikolay Aleksandrov 	goto out;
12172594e906SNikolay Aleksandrov }
12182594e906SNikolay Aleksandrov 
1219169327d5SPetr Machata int nbp_vlan_init(struct net_bridge_port *p, struct netlink_ext_ack *extack)
12202594e906SNikolay Aleksandrov {
1221404cdbf0SElad Raz 	struct switchdev_attr attr = {
1222404cdbf0SElad Raz 		.orig_dev = p->br->dev,
1223404cdbf0SElad Raz 		.id = SWITCHDEV_ATTR_ID_BRIDGE_VLAN_FILTERING,
1224404cdbf0SElad Raz 		.flags = SWITCHDEV_F_SKIP_EOPNOTSUPP,
1225ae75767eSNikolay Aleksandrov 		.u.vlan_filtering = br_opt_get(p->br, BROPT_VLAN_ENABLED),
1226404cdbf0SElad Raz 	};
1227263344e6SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
12282594e906SNikolay Aleksandrov 	int ret = -ENOMEM;
12292594e906SNikolay Aleksandrov 
1230263344e6SNikolay Aleksandrov 	vg = kzalloc(sizeof(struct net_bridge_vlan_group), GFP_KERNEL);
1231263344e6SNikolay Aleksandrov 	if (!vg)
12322594e906SNikolay Aleksandrov 		goto out;
12332594e906SNikolay Aleksandrov 
1234dcbdf135SVladimir Oltean 	ret = switchdev_port_attr_set(p->dev, &attr, extack);
1235404cdbf0SElad Raz 	if (ret && ret != -EOPNOTSUPP)
1236404cdbf0SElad Raz 		goto err_vlan_enabled;
1237404cdbf0SElad Raz 
1238263344e6SNikolay Aleksandrov 	ret = rhashtable_init(&vg->vlan_hash, &br_vlan_rht_params);
12392594e906SNikolay Aleksandrov 	if (ret)
12402594e906SNikolay Aleksandrov 		goto err_rhtbl;
1241efa5356bSRoopa Prabhu 	ret = vlan_tunnel_init(vg);
1242efa5356bSRoopa Prabhu 	if (ret)
1243efa5356bSRoopa Prabhu 		goto err_tunnel_init;
1244263344e6SNikolay Aleksandrov 	INIT_LIST_HEAD(&vg->vlan_list);
1245907b1e6eSNikolay Aleksandrov 	rcu_assign_pointer(p->vlgrp, vg);
12462594e906SNikolay Aleksandrov 	if (p->br->default_pvid) {
1247f418af63SNikolay Aleksandrov 		bool changed;
1248f418af63SNikolay Aleksandrov 
12492594e906SNikolay Aleksandrov 		ret = nbp_vlan_add(p, p->br->default_pvid,
12502594e906SNikolay Aleksandrov 				   BRIDGE_VLAN_INFO_PVID |
1251f418af63SNikolay Aleksandrov 				   BRIDGE_VLAN_INFO_UNTAGGED,
1252169327d5SPetr Machata 				   &changed, extack);
12532594e906SNikolay Aleksandrov 		if (ret)
12542594e906SNikolay Aleksandrov 			goto err_vlan_add;
1255f545923bSNikolay Aleksandrov 		br_vlan_notify(p->br, p, p->br->default_pvid, 0, RTM_NEWVLAN);
12562594e906SNikolay Aleksandrov 	}
12572594e906SNikolay Aleksandrov out:
12582594e906SNikolay Aleksandrov 	return ret;
12592594e906SNikolay Aleksandrov 
12602594e906SNikolay Aleksandrov err_vlan_add:
126107bc588fSIdo Schimmel 	RCU_INIT_POINTER(p->vlgrp, NULL);
126207bc588fSIdo Schimmel 	synchronize_rcu();
1263efa5356bSRoopa Prabhu 	vlan_tunnel_deinit(vg);
1264efa5356bSRoopa Prabhu err_tunnel_init:
1265efa5356bSRoopa Prabhu 	rhashtable_destroy(&vg->vlan_hash);
12662594e906SNikolay Aleksandrov err_rhtbl:
1267df2c4334SYotam Gigi err_vlan_enabled:
1268263344e6SNikolay Aleksandrov 	kfree(vg);
12692594e906SNikolay Aleksandrov 
12702594e906SNikolay Aleksandrov 	goto out;
12718580e211SToshiaki Makita }
12728580e211SToshiaki Makita 
12738adff41cSToshiaki Makita /* Must be protected by RTNL.
12748adff41cSToshiaki Makita  * Must be called with vid in range from 1 to 4094 inclusive.
1275f418af63SNikolay Aleksandrov  * changed must be true only if the vlan was created or updated
12768adff41cSToshiaki Makita  */
1277f418af63SNikolay Aleksandrov int nbp_vlan_add(struct net_bridge_port *port, u16 vid, u16 flags,
1278169327d5SPetr Machata 		 bool *changed, struct netlink_ext_ack *extack)
1279243a2e63SVlad Yasevich {
12802594e906SNikolay Aleksandrov 	struct net_bridge_vlan *vlan;
12812594e906SNikolay Aleksandrov 	int ret;
1282243a2e63SVlad Yasevich 
1283243a2e63SVlad Yasevich 	ASSERT_RTNL();
1284243a2e63SVlad Yasevich 
1285f418af63SNikolay Aleksandrov 	*changed = false;
1286907b1e6eSNikolay Aleksandrov 	vlan = br_vlan_find(nbp_vlan_group(port), vid);
12872594e906SNikolay Aleksandrov 	if (vlan) {
1288*27c5f74cSVladimir Oltean 		bool would_change = __vlan_flags_would_change(vlan, flags);
1289*27c5f74cSVladimir Oltean 
1290*27c5f74cSVladimir Oltean 		if (would_change) {
12917fbac984SIdo Schimmel 			/* Pass the flags to the hardware bridge */
1292*27c5f74cSVladimir Oltean 			ret = br_switchdev_port_vlan_add(port->dev, vid,
1293*27c5f74cSVladimir Oltean 							 flags, extack);
12947fbac984SIdo Schimmel 			if (ret && ret != -EOPNOTSUPP)
12957fbac984SIdo Schimmel 				return ret;
1296*27c5f74cSVladimir Oltean 		}
1297*27c5f74cSVladimir Oltean 
1298*27c5f74cSVladimir Oltean 		__vlan_flags_commit(vlan, flags);
1299*27c5f74cSVladimir Oltean 		*changed = would_change;
1300f418af63SNikolay Aleksandrov 
13012594e906SNikolay Aleksandrov 		return 0;
1302243a2e63SVlad Yasevich 	}
1303243a2e63SVlad Yasevich 
13042594e906SNikolay Aleksandrov 	vlan = kzalloc(sizeof(*vlan), GFP_KERNEL);
13052594e906SNikolay Aleksandrov 	if (!vlan)
13062594e906SNikolay Aleksandrov 		return -ENOMEM;
1307243a2e63SVlad Yasevich 
13082594e906SNikolay Aleksandrov 	vlan->vid = vid;
13092594e906SNikolay Aleksandrov 	vlan->port = port;
1310169327d5SPetr Machata 	ret = __vlan_add(vlan, flags, extack);
13112594e906SNikolay Aleksandrov 	if (ret)
13122594e906SNikolay Aleksandrov 		kfree(vlan);
1313f418af63SNikolay Aleksandrov 	else
1314f418af63SNikolay Aleksandrov 		*changed = true;
1315243a2e63SVlad Yasevich 
13162594e906SNikolay Aleksandrov 	return ret;
1317243a2e63SVlad Yasevich }
1318243a2e63SVlad Yasevich 
13198adff41cSToshiaki Makita /* Must be protected by RTNL.
13208adff41cSToshiaki Makita  * Must be called with vid in range from 1 to 4094 inclusive.
13218adff41cSToshiaki Makita  */
1322243a2e63SVlad Yasevich int nbp_vlan_delete(struct net_bridge_port *port, u16 vid)
1323243a2e63SVlad Yasevich {
13242594e906SNikolay Aleksandrov 	struct net_bridge_vlan *v;
1325243a2e63SVlad Yasevich 
1326243a2e63SVlad Yasevich 	ASSERT_RTNL();
1327243a2e63SVlad Yasevich 
1328907b1e6eSNikolay Aleksandrov 	v = br_vlan_find(nbp_vlan_group(port), vid);
13292594e906SNikolay Aleksandrov 	if (!v)
13302594e906SNikolay Aleksandrov 		return -ENOENT;
1331424bb9c9SToshiaki Makita 	br_fdb_find_delete_local(port->br, port, port->dev->dev_addr, vid);
13321ea2d020SNikolay Aleksandrov 	br_fdb_delete_by_port(port->br, port, vid, 0);
1333bc9a25d2SVlad Yasevich 
13342594e906SNikolay Aleksandrov 	return __vlan_del(v);
1335243a2e63SVlad Yasevich }
1336243a2e63SVlad Yasevich 
1337243a2e63SVlad Yasevich void nbp_vlan_flush(struct net_bridge_port *port)
1338243a2e63SVlad Yasevich {
1339f409d0edSNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
1340f409d0edSNikolay Aleksandrov 
1341243a2e63SVlad Yasevich 	ASSERT_RTNL();
1342243a2e63SVlad Yasevich 
1343f409d0edSNikolay Aleksandrov 	vg = nbp_vlan_group(port);
1344f545923bSNikolay Aleksandrov 	__vlan_flush(port->br, port, vg);
1345f409d0edSNikolay Aleksandrov 	RCU_INIT_POINTER(port->vlgrp, NULL);
1346f409d0edSNikolay Aleksandrov 	synchronize_rcu();
1347f409d0edSNikolay Aleksandrov 	__vlan_group_free(vg);
13485be5a2dfSVlad Yasevich }
1349a60c0903SNikolay Aleksandrov 
1350a60c0903SNikolay Aleksandrov void br_vlan_get_stats(const struct net_bridge_vlan *v,
1351281cc284SHeiner Kallweit 		       struct pcpu_sw_netstats *stats)
1352a60c0903SNikolay Aleksandrov {
1353a60c0903SNikolay Aleksandrov 	int i;
1354a60c0903SNikolay Aleksandrov 
1355a60c0903SNikolay Aleksandrov 	memset(stats, 0, sizeof(*stats));
1356a60c0903SNikolay Aleksandrov 	for_each_possible_cpu(i) {
1357a60c0903SNikolay Aleksandrov 		u64 rxpackets, rxbytes, txpackets, txbytes;
1358281cc284SHeiner Kallweit 		struct pcpu_sw_netstats *cpu_stats;
1359a60c0903SNikolay Aleksandrov 		unsigned int start;
1360a60c0903SNikolay Aleksandrov 
1361a60c0903SNikolay Aleksandrov 		cpu_stats = per_cpu_ptr(v->stats, i);
1362a60c0903SNikolay Aleksandrov 		do {
1363a60c0903SNikolay Aleksandrov 			start = u64_stats_fetch_begin_irq(&cpu_stats->syncp);
1364a60c0903SNikolay Aleksandrov 			rxpackets = cpu_stats->rx_packets;
1365a60c0903SNikolay Aleksandrov 			rxbytes = cpu_stats->rx_bytes;
1366a60c0903SNikolay Aleksandrov 			txbytes = cpu_stats->tx_bytes;
1367a60c0903SNikolay Aleksandrov 			txpackets = cpu_stats->tx_packets;
1368a60c0903SNikolay Aleksandrov 		} while (u64_stats_fetch_retry_irq(&cpu_stats->syncp, start));
1369a60c0903SNikolay Aleksandrov 
1370a60c0903SNikolay Aleksandrov 		stats->rx_packets += rxpackets;
1371a60c0903SNikolay Aleksandrov 		stats->rx_bytes += rxbytes;
1372a60c0903SNikolay Aleksandrov 		stats->tx_bytes += txbytes;
1373a60c0903SNikolay Aleksandrov 		stats->tx_packets += txpackets;
1374a60c0903SNikolay Aleksandrov 	}
1375a60c0903SNikolay Aleksandrov }
13764d4fd361SPetr Machata 
137799f62a74SVladimir Oltean int br_vlan_get_pvid(const struct net_device *dev, u16 *p_pvid)
13784d4fd361SPetr Machata {
13794d4fd361SPetr Machata 	struct net_bridge_vlan_group *vg;
138099f62a74SVladimir Oltean 	struct net_bridge_port *p;
13814d4fd361SPetr Machata 
138299f62a74SVladimir Oltean 	ASSERT_RTNL();
138399f62a74SVladimir Oltean 	p = br_port_get_check_rtnl(dev);
13845a6db04cSIdo Schimmel 	if (p)
13855a6db04cSIdo Schimmel 		vg = nbp_vlan_group(p);
13865a6db04cSIdo Schimmel 	else if (netif_is_bridge_master(dev))
13874d4fd361SPetr Machata 		vg = br_vlan_group(netdev_priv(dev));
13884d4fd361SPetr Machata 	else
13894d4fd361SPetr Machata 		return -EINVAL;
13904d4fd361SPetr Machata 
13914d4fd361SPetr Machata 	*p_pvid = br_get_pvid(vg);
13924d4fd361SPetr Machata 	return 0;
13934d4fd361SPetr Machata }
13944d4fd361SPetr Machata EXPORT_SYMBOL_GPL(br_vlan_get_pvid);
13954d4fd361SPetr Machata 
13967582f5b7SPablo Neira Ayuso int br_vlan_get_pvid_rcu(const struct net_device *dev, u16 *p_pvid)
13977582f5b7SPablo Neira Ayuso {
139899f62a74SVladimir Oltean 	struct net_bridge_vlan_group *vg;
139999f62a74SVladimir Oltean 	struct net_bridge_port *p;
140099f62a74SVladimir Oltean 
140199f62a74SVladimir Oltean 	p = br_port_get_check_rcu(dev);
140299f62a74SVladimir Oltean 	if (p)
140399f62a74SVladimir Oltean 		vg = nbp_vlan_group_rcu(p);
140499f62a74SVladimir Oltean 	else if (netif_is_bridge_master(dev))
140599f62a74SVladimir Oltean 		vg = br_vlan_group_rcu(netdev_priv(dev));
140699f62a74SVladimir Oltean 	else
140799f62a74SVladimir Oltean 		return -EINVAL;
140899f62a74SVladimir Oltean 
140999f62a74SVladimir Oltean 	*p_pvid = br_get_pvid(vg);
141099f62a74SVladimir Oltean 	return 0;
14117582f5b7SPablo Neira Ayuso }
14127582f5b7SPablo Neira Ayuso EXPORT_SYMBOL_GPL(br_vlan_get_pvid_rcu);
14137582f5b7SPablo Neira Ayuso 
1414bcf2766bSFelix Fietkau void br_vlan_fill_forward_path_pvid(struct net_bridge *br,
1415bcf2766bSFelix Fietkau 				    struct net_device_path_ctx *ctx,
1416bcf2766bSFelix Fietkau 				    struct net_device_path *path)
1417bcf2766bSFelix Fietkau {
1418bcf2766bSFelix Fietkau 	struct net_bridge_vlan_group *vg;
1419bcf2766bSFelix Fietkau 	int idx = ctx->num_vlans - 1;
1420bcf2766bSFelix Fietkau 	u16 vid;
1421bcf2766bSFelix Fietkau 
1422bcf2766bSFelix Fietkau 	path->bridge.vlan_mode = DEV_PATH_BR_VLAN_KEEP;
1423bcf2766bSFelix Fietkau 
1424bcf2766bSFelix Fietkau 	if (!br_opt_get(br, BROPT_VLAN_ENABLED))
1425bcf2766bSFelix Fietkau 		return;
1426bcf2766bSFelix Fietkau 
1427bcf2766bSFelix Fietkau 	vg = br_vlan_group(br);
1428bcf2766bSFelix Fietkau 
1429bcf2766bSFelix Fietkau 	if (idx >= 0 &&
1430bcf2766bSFelix Fietkau 	    ctx->vlan[idx].proto == br->vlan_proto) {
1431bcf2766bSFelix Fietkau 		vid = ctx->vlan[idx].id;
1432bcf2766bSFelix Fietkau 	} else {
1433bcf2766bSFelix Fietkau 		path->bridge.vlan_mode = DEV_PATH_BR_VLAN_TAG;
1434bcf2766bSFelix Fietkau 		vid = br_get_pvid(vg);
1435bcf2766bSFelix Fietkau 	}
1436bcf2766bSFelix Fietkau 
1437bcf2766bSFelix Fietkau 	path->bridge.vlan_id = vid;
1438bcf2766bSFelix Fietkau 	path->bridge.vlan_proto = br->vlan_proto;
1439bcf2766bSFelix Fietkau }
1440bcf2766bSFelix Fietkau 
1441bcf2766bSFelix Fietkau int br_vlan_fill_forward_path_mode(struct net_bridge *br,
1442bcf2766bSFelix Fietkau 				   struct net_bridge_port *dst,
1443bcf2766bSFelix Fietkau 				   struct net_device_path *path)
1444bcf2766bSFelix Fietkau {
1445bcf2766bSFelix Fietkau 	struct net_bridge_vlan_group *vg;
1446bcf2766bSFelix Fietkau 	struct net_bridge_vlan *v;
1447bcf2766bSFelix Fietkau 
1448bcf2766bSFelix Fietkau 	if (!br_opt_get(br, BROPT_VLAN_ENABLED))
1449bcf2766bSFelix Fietkau 		return 0;
1450bcf2766bSFelix Fietkau 
1451bcf2766bSFelix Fietkau 	vg = nbp_vlan_group_rcu(dst);
1452bcf2766bSFelix Fietkau 	v = br_vlan_find(vg, path->bridge.vlan_id);
1453bcf2766bSFelix Fietkau 	if (!v || !br_vlan_should_use(v))
1454bcf2766bSFelix Fietkau 		return -EINVAL;
1455bcf2766bSFelix Fietkau 
1456bcf2766bSFelix Fietkau 	if (!(v->flags & BRIDGE_VLAN_INFO_UNTAGGED))
1457bcf2766bSFelix Fietkau 		return 0;
1458bcf2766bSFelix Fietkau 
1459bcf2766bSFelix Fietkau 	if (path->bridge.vlan_mode == DEV_PATH_BR_VLAN_TAG)
1460bcf2766bSFelix Fietkau 		path->bridge.vlan_mode = DEV_PATH_BR_VLAN_KEEP;
146126267bf9SFelix Fietkau 	else if (v->priv_flags & BR_VLFLAG_ADDED_BY_SWITCHDEV)
146226267bf9SFelix Fietkau 		path->bridge.vlan_mode = DEV_PATH_BR_VLAN_UNTAG_HW;
1463bcf2766bSFelix Fietkau 	else
1464bcf2766bSFelix Fietkau 		path->bridge.vlan_mode = DEV_PATH_BR_VLAN_UNTAG;
1465bcf2766bSFelix Fietkau 
1466bcf2766bSFelix Fietkau 	return 0;
1467bcf2766bSFelix Fietkau }
1468bcf2766bSFelix Fietkau 
14694d4fd361SPetr Machata int br_vlan_get_info(const struct net_device *dev, u16 vid,
14704d4fd361SPetr Machata 		     struct bridge_vlan_info *p_vinfo)
14714d4fd361SPetr Machata {
14724d4fd361SPetr Machata 	struct net_bridge_vlan_group *vg;
14734d4fd361SPetr Machata 	struct net_bridge_vlan *v;
14744d4fd361SPetr Machata 	struct net_bridge_port *p;
14754d4fd361SPetr Machata 
14764d4fd361SPetr Machata 	ASSERT_RTNL();
14774d4fd361SPetr Machata 	p = br_port_get_check_rtnl(dev);
14784d4fd361SPetr Machata 	if (p)
14794d4fd361SPetr Machata 		vg = nbp_vlan_group(p);
14802b18d79eSPetr Machata 	else if (netif_is_bridge_master(dev))
14812b18d79eSPetr Machata 		vg = br_vlan_group(netdev_priv(dev));
14824d4fd361SPetr Machata 	else
14834d4fd361SPetr Machata 		return -EINVAL;
14844d4fd361SPetr Machata 
14854d4fd361SPetr Machata 	v = br_vlan_find(vg, vid);
14864d4fd361SPetr Machata 	if (!v)
14874d4fd361SPetr Machata 		return -ENOENT;
14884d4fd361SPetr Machata 
14894d4fd361SPetr Machata 	p_vinfo->vid = vid;
14904d4fd361SPetr Machata 	p_vinfo->flags = v->flags;
1491f40d9b20SVladimir Oltean 	if (vid == br_get_pvid(vg))
1492f40d9b20SVladimir Oltean 		p_vinfo->flags |= BRIDGE_VLAN_INFO_PVID;
14934d4fd361SPetr Machata 	return 0;
14944d4fd361SPetr Machata }
14954d4fd361SPetr Machata EXPORT_SYMBOL_GPL(br_vlan_get_info);
14969c0ec2e7SMike Manning 
1497ee80dd2eSVladimir Oltean int br_vlan_get_info_rcu(const struct net_device *dev, u16 vid,
1498ee80dd2eSVladimir Oltean 			 struct bridge_vlan_info *p_vinfo)
1499ee80dd2eSVladimir Oltean {
1500ee80dd2eSVladimir Oltean 	struct net_bridge_vlan_group *vg;
1501ee80dd2eSVladimir Oltean 	struct net_bridge_vlan *v;
1502ee80dd2eSVladimir Oltean 	struct net_bridge_port *p;
1503ee80dd2eSVladimir Oltean 
1504ee80dd2eSVladimir Oltean 	p = br_port_get_check_rcu(dev);
1505ee80dd2eSVladimir Oltean 	if (p)
1506ee80dd2eSVladimir Oltean 		vg = nbp_vlan_group_rcu(p);
1507ee80dd2eSVladimir Oltean 	else if (netif_is_bridge_master(dev))
1508ee80dd2eSVladimir Oltean 		vg = br_vlan_group_rcu(netdev_priv(dev));
1509ee80dd2eSVladimir Oltean 	else
1510ee80dd2eSVladimir Oltean 		return -EINVAL;
1511ee80dd2eSVladimir Oltean 
1512ee80dd2eSVladimir Oltean 	v = br_vlan_find(vg, vid);
1513ee80dd2eSVladimir Oltean 	if (!v)
1514ee80dd2eSVladimir Oltean 		return -ENOENT;
1515ee80dd2eSVladimir Oltean 
1516ee80dd2eSVladimir Oltean 	p_vinfo->vid = vid;
1517ee80dd2eSVladimir Oltean 	p_vinfo->flags = v->flags;
1518ee80dd2eSVladimir Oltean 	if (vid == br_get_pvid(vg))
1519ee80dd2eSVladimir Oltean 		p_vinfo->flags |= BRIDGE_VLAN_INFO_PVID;
1520ee80dd2eSVladimir Oltean 	return 0;
1521ee80dd2eSVladimir Oltean }
1522ee80dd2eSVladimir Oltean EXPORT_SYMBOL_GPL(br_vlan_get_info_rcu);
1523ee80dd2eSVladimir Oltean 
15249c0ec2e7SMike Manning static int br_vlan_is_bind_vlan_dev(const struct net_device *dev)
15259c0ec2e7SMike Manning {
15269c0ec2e7SMike Manning 	return is_vlan_dev(dev) &&
15279c0ec2e7SMike Manning 		!!(vlan_dev_priv(dev)->flags & VLAN_FLAG_BRIDGE_BINDING);
15289c0ec2e7SMike Manning }
15299c0ec2e7SMike Manning 
15309c0ec2e7SMike Manning static int br_vlan_is_bind_vlan_dev_fn(struct net_device *dev,
1531eff74233STaehee Yoo 			       __always_unused struct netdev_nested_priv *priv)
15329c0ec2e7SMike Manning {
15339c0ec2e7SMike Manning 	return br_vlan_is_bind_vlan_dev(dev);
15349c0ec2e7SMike Manning }
15359c0ec2e7SMike Manning 
15369c0ec2e7SMike Manning static bool br_vlan_has_upper_bind_vlan_dev(struct net_device *dev)
15379c0ec2e7SMike Manning {
15389c0ec2e7SMike Manning 	int found;
15399c0ec2e7SMike Manning 
15409c0ec2e7SMike Manning 	rcu_read_lock();
15419c0ec2e7SMike Manning 	found = netdev_walk_all_upper_dev_rcu(dev, br_vlan_is_bind_vlan_dev_fn,
15429c0ec2e7SMike Manning 					      NULL);
15439c0ec2e7SMike Manning 	rcu_read_unlock();
15449c0ec2e7SMike Manning 
15459c0ec2e7SMike Manning 	return !!found;
15469c0ec2e7SMike Manning }
15479c0ec2e7SMike Manning 
15489c0ec2e7SMike Manning struct br_vlan_bind_walk_data {
15499c0ec2e7SMike Manning 	u16 vid;
15509c0ec2e7SMike Manning 	struct net_device *result;
15519c0ec2e7SMike Manning };
15529c0ec2e7SMike Manning 
15539c0ec2e7SMike Manning static int br_vlan_match_bind_vlan_dev_fn(struct net_device *dev,
1554eff74233STaehee Yoo 					  struct netdev_nested_priv *priv)
15559c0ec2e7SMike Manning {
1556eff74233STaehee Yoo 	struct br_vlan_bind_walk_data *data = priv->data;
15579c0ec2e7SMike Manning 	int found = 0;
15589c0ec2e7SMike Manning 
15599c0ec2e7SMike Manning 	if (br_vlan_is_bind_vlan_dev(dev) &&
15609c0ec2e7SMike Manning 	    vlan_dev_priv(dev)->vlan_id == data->vid) {
15619c0ec2e7SMike Manning 		data->result = dev;
15629c0ec2e7SMike Manning 		found = 1;
15639c0ec2e7SMike Manning 	}
15649c0ec2e7SMike Manning 
15659c0ec2e7SMike Manning 	return found;
15669c0ec2e7SMike Manning }
15679c0ec2e7SMike Manning 
15689c0ec2e7SMike Manning static struct net_device *
15699c0ec2e7SMike Manning br_vlan_get_upper_bind_vlan_dev(struct net_device *dev, u16 vid)
15709c0ec2e7SMike Manning {
15719c0ec2e7SMike Manning 	struct br_vlan_bind_walk_data data = {
15729c0ec2e7SMike Manning 		.vid = vid,
15739c0ec2e7SMike Manning 	};
1574eff74233STaehee Yoo 	struct netdev_nested_priv priv = {
1575eff74233STaehee Yoo 		.data = (void *)&data,
1576eff74233STaehee Yoo 	};
15779c0ec2e7SMike Manning 
15789c0ec2e7SMike Manning 	rcu_read_lock();
15799c0ec2e7SMike Manning 	netdev_walk_all_upper_dev_rcu(dev, br_vlan_match_bind_vlan_dev_fn,
1580eff74233STaehee Yoo 				      &priv);
15819c0ec2e7SMike Manning 	rcu_read_unlock();
15829c0ec2e7SMike Manning 
15839c0ec2e7SMike Manning 	return data.result;
15849c0ec2e7SMike Manning }
15859c0ec2e7SMike Manning 
15869c0ec2e7SMike Manning static bool br_vlan_is_dev_up(const struct net_device *dev)
15879c0ec2e7SMike Manning {
15889c0ec2e7SMike Manning 	return  !!(dev->flags & IFF_UP) && netif_oper_up(dev);
15899c0ec2e7SMike Manning }
15909c0ec2e7SMike Manning 
15919c0ec2e7SMike Manning static void br_vlan_set_vlan_dev_state(const struct net_bridge *br,
15929c0ec2e7SMike Manning 				       struct net_device *vlan_dev)
15939c0ec2e7SMike Manning {
15949c0ec2e7SMike Manning 	u16 vid = vlan_dev_priv(vlan_dev)->vlan_id;
15959c0ec2e7SMike Manning 	struct net_bridge_vlan_group *vg;
15969c0ec2e7SMike Manning 	struct net_bridge_port *p;
15979c0ec2e7SMike Manning 	bool has_carrier = false;
15989c0ec2e7SMike Manning 
15998e1acd4fSMike Manning 	if (!netif_carrier_ok(br->dev)) {
16008e1acd4fSMike Manning 		netif_carrier_off(vlan_dev);
16018e1acd4fSMike Manning 		return;
16028e1acd4fSMike Manning 	}
16038e1acd4fSMike Manning 
16049c0ec2e7SMike Manning 	list_for_each_entry(p, &br->port_list, list) {
16059c0ec2e7SMike Manning 		vg = nbp_vlan_group(p);
16069c0ec2e7SMike Manning 		if (br_vlan_find(vg, vid) && br_vlan_is_dev_up(p->dev)) {
16079c0ec2e7SMike Manning 			has_carrier = true;
16089c0ec2e7SMike Manning 			break;
16099c0ec2e7SMike Manning 		}
16109c0ec2e7SMike Manning 	}
16119c0ec2e7SMike Manning 
16129c0ec2e7SMike Manning 	if (has_carrier)
16139c0ec2e7SMike Manning 		netif_carrier_on(vlan_dev);
16149c0ec2e7SMike Manning 	else
16159c0ec2e7SMike Manning 		netif_carrier_off(vlan_dev);
16169c0ec2e7SMike Manning }
16179c0ec2e7SMike Manning 
16189c0ec2e7SMike Manning static void br_vlan_set_all_vlan_dev_state(struct net_bridge_port *p)
16199c0ec2e7SMike Manning {
16209c0ec2e7SMike Manning 	struct net_bridge_vlan_group *vg = nbp_vlan_group(p);
16219c0ec2e7SMike Manning 	struct net_bridge_vlan *vlan;
16229c0ec2e7SMike Manning 	struct net_device *vlan_dev;
16239c0ec2e7SMike Manning 
16249c0ec2e7SMike Manning 	list_for_each_entry(vlan, &vg->vlan_list, vlist) {
16259c0ec2e7SMike Manning 		vlan_dev = br_vlan_get_upper_bind_vlan_dev(p->br->dev,
16269c0ec2e7SMike Manning 							   vlan->vid);
16279c0ec2e7SMike Manning 		if (vlan_dev) {
16288e1acd4fSMike Manning 			if (br_vlan_is_dev_up(p->dev)) {
16298e1acd4fSMike Manning 				if (netif_carrier_ok(p->br->dev))
16309c0ec2e7SMike Manning 					netif_carrier_on(vlan_dev);
16318e1acd4fSMike Manning 			} else {
16329c0ec2e7SMike Manning 				br_vlan_set_vlan_dev_state(p->br, vlan_dev);
16339c0ec2e7SMike Manning 			}
16349c0ec2e7SMike Manning 		}
16359c0ec2e7SMike Manning 	}
16368e1acd4fSMike Manning }
16379c0ec2e7SMike Manning 
16389c0ec2e7SMike Manning static void br_vlan_upper_change(struct net_device *dev,
16399c0ec2e7SMike Manning 				 struct net_device *upper_dev,
16409c0ec2e7SMike Manning 				 bool linking)
16419c0ec2e7SMike Manning {
16429c0ec2e7SMike Manning 	struct net_bridge *br = netdev_priv(dev);
16439c0ec2e7SMike Manning 
16449c0ec2e7SMike Manning 	if (!br_vlan_is_bind_vlan_dev(upper_dev))
16459c0ec2e7SMike Manning 		return;
16469c0ec2e7SMike Manning 
16479c0ec2e7SMike Manning 	if (linking) {
16489c0ec2e7SMike Manning 		br_vlan_set_vlan_dev_state(br, upper_dev);
16499c0ec2e7SMike Manning 		br_opt_toggle(br, BROPT_VLAN_BRIDGE_BINDING, true);
16509c0ec2e7SMike Manning 	} else {
16519c0ec2e7SMike Manning 		br_opt_toggle(br, BROPT_VLAN_BRIDGE_BINDING,
16529c0ec2e7SMike Manning 			      br_vlan_has_upper_bind_vlan_dev(dev));
16539c0ec2e7SMike Manning 	}
16549c0ec2e7SMike Manning }
16559c0ec2e7SMike Manning 
16568e1acd4fSMike Manning struct br_vlan_link_state_walk_data {
16578e1acd4fSMike Manning 	struct net_bridge *br;
16588e1acd4fSMike Manning };
16598e1acd4fSMike Manning 
16608e1acd4fSMike Manning static int br_vlan_link_state_change_fn(struct net_device *vlan_dev,
1661eff74233STaehee Yoo 					struct netdev_nested_priv *priv)
16628e1acd4fSMike Manning {
1663eff74233STaehee Yoo 	struct br_vlan_link_state_walk_data *data = priv->data;
16648e1acd4fSMike Manning 
16658e1acd4fSMike Manning 	if (br_vlan_is_bind_vlan_dev(vlan_dev))
16668e1acd4fSMike Manning 		br_vlan_set_vlan_dev_state(data->br, vlan_dev);
16678e1acd4fSMike Manning 
16688e1acd4fSMike Manning 	return 0;
16698e1acd4fSMike Manning }
16708e1acd4fSMike Manning 
16718e1acd4fSMike Manning static void br_vlan_link_state_change(struct net_device *dev,
16728e1acd4fSMike Manning 				      struct net_bridge *br)
16738e1acd4fSMike Manning {
16748e1acd4fSMike Manning 	struct br_vlan_link_state_walk_data data = {
16758e1acd4fSMike Manning 		.br = br
16768e1acd4fSMike Manning 	};
1677eff74233STaehee Yoo 	struct netdev_nested_priv priv = {
1678eff74233STaehee Yoo 		.data = (void *)&data,
1679eff74233STaehee Yoo 	};
16808e1acd4fSMike Manning 
16818e1acd4fSMike Manning 	rcu_read_lock();
16828e1acd4fSMike Manning 	netdev_walk_all_upper_dev_rcu(dev, br_vlan_link_state_change_fn,
1683eff74233STaehee Yoo 				      &priv);
16848e1acd4fSMike Manning 	rcu_read_unlock();
16858e1acd4fSMike Manning }
16868e1acd4fSMike Manning 
16879c0ec2e7SMike Manning /* Must be protected by RTNL. */
168880900acdSMike Manning static void nbp_vlan_set_vlan_dev_state(struct net_bridge_port *p, u16 vid)
168980900acdSMike Manning {
169080900acdSMike Manning 	struct net_device *vlan_dev;
169180900acdSMike Manning 
169280900acdSMike Manning 	if (!br_opt_get(p->br, BROPT_VLAN_BRIDGE_BINDING))
169380900acdSMike Manning 		return;
169480900acdSMike Manning 
169580900acdSMike Manning 	vlan_dev = br_vlan_get_upper_bind_vlan_dev(p->br->dev, vid);
169680900acdSMike Manning 	if (vlan_dev)
169780900acdSMike Manning 		br_vlan_set_vlan_dev_state(p->br, vlan_dev);
169880900acdSMike Manning }
169980900acdSMike Manning 
170080900acdSMike Manning /* Must be protected by RTNL. */
1701091adf9bSNikolay Aleksandrov int br_vlan_bridge_event(struct net_device *dev, unsigned long event, void *ptr)
17029c0ec2e7SMike Manning {
17039c0ec2e7SMike Manning 	struct netdev_notifier_changeupper_info *info;
1704091adf9bSNikolay Aleksandrov 	struct net_bridge *br = netdev_priv(dev);
1705f545923bSNikolay Aleksandrov 	int vlcmd = 0, ret = 0;
1706f545923bSNikolay Aleksandrov 	bool changed = false;
17079c0ec2e7SMike Manning 
17089c0ec2e7SMike Manning 	switch (event) {
1709091adf9bSNikolay Aleksandrov 	case NETDEV_REGISTER:
1710091adf9bSNikolay Aleksandrov 		ret = br_vlan_add(br, br->default_pvid,
1711091adf9bSNikolay Aleksandrov 				  BRIDGE_VLAN_INFO_PVID |
1712091adf9bSNikolay Aleksandrov 				  BRIDGE_VLAN_INFO_UNTAGGED |
1713091adf9bSNikolay Aleksandrov 				  BRIDGE_VLAN_INFO_BRENTRY, &changed, NULL);
1714f545923bSNikolay Aleksandrov 		vlcmd = RTM_NEWVLAN;
1715091adf9bSNikolay Aleksandrov 		break;
1716091adf9bSNikolay Aleksandrov 	case NETDEV_UNREGISTER:
1717f545923bSNikolay Aleksandrov 		changed = !br_vlan_delete(br, br->default_pvid);
1718f545923bSNikolay Aleksandrov 		vlcmd = RTM_DELVLAN;
1719091adf9bSNikolay Aleksandrov 		break;
17209c0ec2e7SMike Manning 	case NETDEV_CHANGEUPPER:
17219c0ec2e7SMike Manning 		info = ptr;
17229c0ec2e7SMike Manning 		br_vlan_upper_change(dev, info->upper_dev, info->linking);
17239c0ec2e7SMike Manning 		break;
17248e1acd4fSMike Manning 
17258e1acd4fSMike Manning 	case NETDEV_CHANGE:
17268e1acd4fSMike Manning 	case NETDEV_UP:
17278e1acd4fSMike Manning 		if (!br_opt_get(br, BROPT_VLAN_BRIDGE_BINDING))
1728091adf9bSNikolay Aleksandrov 			break;
17298e1acd4fSMike Manning 		br_vlan_link_state_change(dev, br);
17308e1acd4fSMike Manning 		break;
17319c0ec2e7SMike Manning 	}
1732f545923bSNikolay Aleksandrov 	if (changed)
1733f545923bSNikolay Aleksandrov 		br_vlan_notify(br, NULL, br->default_pvid, 0, vlcmd);
1734091adf9bSNikolay Aleksandrov 
1735091adf9bSNikolay Aleksandrov 	return ret;
17369c0ec2e7SMike Manning }
17379c0ec2e7SMike Manning 
17389c0ec2e7SMike Manning /* Must be protected by RTNL. */
17399c0ec2e7SMike Manning void br_vlan_port_event(struct net_bridge_port *p, unsigned long event)
17409c0ec2e7SMike Manning {
17419c0ec2e7SMike Manning 	if (!br_opt_get(p->br, BROPT_VLAN_BRIDGE_BINDING))
17429c0ec2e7SMike Manning 		return;
17439c0ec2e7SMike Manning 
17449c0ec2e7SMike Manning 	switch (event) {
17459c0ec2e7SMike Manning 	case NETDEV_CHANGE:
17469c0ec2e7SMike Manning 	case NETDEV_DOWN:
17479c0ec2e7SMike Manning 	case NETDEV_UP:
17489c0ec2e7SMike Manning 		br_vlan_set_all_vlan_dev_state(p);
17499c0ec2e7SMike Manning 		break;
17509c0ec2e7SMike Manning 	}
17519c0ec2e7SMike Manning }
17528dcea187SNikolay Aleksandrov 
175356d09976SNikolay Aleksandrov static bool br_vlan_stats_fill(struct sk_buff *skb,
175456d09976SNikolay Aleksandrov 			       const struct net_bridge_vlan *v)
175556d09976SNikolay Aleksandrov {
1756281cc284SHeiner Kallweit 	struct pcpu_sw_netstats stats;
175756d09976SNikolay Aleksandrov 	struct nlattr *nest;
175856d09976SNikolay Aleksandrov 
175956d09976SNikolay Aleksandrov 	nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY_STATS);
176056d09976SNikolay Aleksandrov 	if (!nest)
176156d09976SNikolay Aleksandrov 		return false;
176256d09976SNikolay Aleksandrov 
176356d09976SNikolay Aleksandrov 	br_vlan_get_stats(v, &stats);
176456d09976SNikolay Aleksandrov 	if (nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_RX_BYTES, stats.rx_bytes,
176556d09976SNikolay Aleksandrov 			      BRIDGE_VLANDB_STATS_PAD) ||
176656d09976SNikolay Aleksandrov 	    nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_RX_PACKETS,
176756d09976SNikolay Aleksandrov 			      stats.rx_packets, BRIDGE_VLANDB_STATS_PAD) ||
176856d09976SNikolay Aleksandrov 	    nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_TX_BYTES, stats.tx_bytes,
176956d09976SNikolay Aleksandrov 			      BRIDGE_VLANDB_STATS_PAD) ||
177056d09976SNikolay Aleksandrov 	    nla_put_u64_64bit(skb, BRIDGE_VLANDB_STATS_TX_PACKETS,
177156d09976SNikolay Aleksandrov 			      stats.tx_packets, BRIDGE_VLANDB_STATS_PAD))
177256d09976SNikolay Aleksandrov 		goto out_err;
177356d09976SNikolay Aleksandrov 
177456d09976SNikolay Aleksandrov 	nla_nest_end(skb, nest);
177556d09976SNikolay Aleksandrov 
177656d09976SNikolay Aleksandrov 	return true;
177756d09976SNikolay Aleksandrov 
177856d09976SNikolay Aleksandrov out_err:
177956d09976SNikolay Aleksandrov 	nla_nest_cancel(skb, nest);
178056d09976SNikolay Aleksandrov 	return false;
178156d09976SNikolay Aleksandrov }
178256d09976SNikolay Aleksandrov 
17837a53e718SNikolay Aleksandrov /* v_opts is used to dump the options which must be equal in the whole range */
17840ab55879SNikolay Aleksandrov static bool br_vlan_fill_vids(struct sk_buff *skb, u16 vid, u16 vid_range,
17857a53e718SNikolay Aleksandrov 			      const struct net_bridge_vlan *v_opts,
178656d09976SNikolay Aleksandrov 			      u16 flags,
178756d09976SNikolay Aleksandrov 			      bool dump_stats)
17888dcea187SNikolay Aleksandrov {
17898dcea187SNikolay Aleksandrov 	struct bridge_vlan_info info;
17908dcea187SNikolay Aleksandrov 	struct nlattr *nest;
17918dcea187SNikolay Aleksandrov 
17928dcea187SNikolay Aleksandrov 	nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY);
17938dcea187SNikolay Aleksandrov 	if (!nest)
17948dcea187SNikolay Aleksandrov 		return false;
17958dcea187SNikolay Aleksandrov 
17968dcea187SNikolay Aleksandrov 	memset(&info, 0, sizeof(info));
17978dcea187SNikolay Aleksandrov 	info.vid = vid;
17988dcea187SNikolay Aleksandrov 	if (flags & BRIDGE_VLAN_INFO_UNTAGGED)
17998dcea187SNikolay Aleksandrov 		info.flags |= BRIDGE_VLAN_INFO_UNTAGGED;
18008dcea187SNikolay Aleksandrov 	if (flags & BRIDGE_VLAN_INFO_PVID)
18018dcea187SNikolay Aleksandrov 		info.flags |= BRIDGE_VLAN_INFO_PVID;
18028dcea187SNikolay Aleksandrov 
18038dcea187SNikolay Aleksandrov 	if (nla_put(skb, BRIDGE_VLANDB_ENTRY_INFO, sizeof(info), &info))
18048dcea187SNikolay Aleksandrov 		goto out_err;
18058dcea187SNikolay Aleksandrov 
18060ab55879SNikolay Aleksandrov 	if (vid_range && vid < vid_range &&
18070ab55879SNikolay Aleksandrov 	    !(flags & BRIDGE_VLAN_INFO_PVID) &&
18080ab55879SNikolay Aleksandrov 	    nla_put_u16(skb, BRIDGE_VLANDB_ENTRY_RANGE, vid_range))
18090ab55879SNikolay Aleksandrov 		goto out_err;
18100ab55879SNikolay Aleksandrov 
181156d09976SNikolay Aleksandrov 	if (v_opts) {
181256d09976SNikolay Aleksandrov 		if (!br_vlan_opts_fill(skb, v_opts))
18137a53e718SNikolay Aleksandrov 			goto out_err;
18147a53e718SNikolay Aleksandrov 
181556d09976SNikolay Aleksandrov 		if (dump_stats && !br_vlan_stats_fill(skb, v_opts))
181656d09976SNikolay Aleksandrov 			goto out_err;
181756d09976SNikolay Aleksandrov 	}
181856d09976SNikolay Aleksandrov 
18198dcea187SNikolay Aleksandrov 	nla_nest_end(skb, nest);
18208dcea187SNikolay Aleksandrov 
18218dcea187SNikolay Aleksandrov 	return true;
18228dcea187SNikolay Aleksandrov 
18238dcea187SNikolay Aleksandrov out_err:
18248dcea187SNikolay Aleksandrov 	nla_nest_cancel(skb, nest);
18258dcea187SNikolay Aleksandrov 	return false;
18268dcea187SNikolay Aleksandrov }
18278dcea187SNikolay Aleksandrov 
1828cf5bddb9SNikolay Aleksandrov static size_t rtnl_vlan_nlmsg_size(void)
1829cf5bddb9SNikolay Aleksandrov {
1830cf5bddb9SNikolay Aleksandrov 	return NLMSG_ALIGN(sizeof(struct br_vlan_msg))
1831cf5bddb9SNikolay Aleksandrov 		+ nla_total_size(0) /* BRIDGE_VLANDB_ENTRY */
1832cf5bddb9SNikolay Aleksandrov 		+ nla_total_size(sizeof(u16)) /* BRIDGE_VLANDB_ENTRY_RANGE */
18337a53e718SNikolay Aleksandrov 		+ nla_total_size(sizeof(struct bridge_vlan_info)) /* BRIDGE_VLANDB_ENTRY_INFO */
18347a53e718SNikolay Aleksandrov 		+ br_vlan_opts_nl_size(); /* bridge vlan options */
1835cf5bddb9SNikolay Aleksandrov }
1836cf5bddb9SNikolay Aleksandrov 
1837cf5bddb9SNikolay Aleksandrov void br_vlan_notify(const struct net_bridge *br,
1838cf5bddb9SNikolay Aleksandrov 		    const struct net_bridge_port *p,
1839cf5bddb9SNikolay Aleksandrov 		    u16 vid, u16 vid_range,
1840cf5bddb9SNikolay Aleksandrov 		    int cmd)
1841cf5bddb9SNikolay Aleksandrov {
1842cf5bddb9SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
18437a53e718SNikolay Aleksandrov 	struct net_bridge_vlan *v = NULL;
1844cf5bddb9SNikolay Aleksandrov 	struct br_vlan_msg *bvm;
1845cf5bddb9SNikolay Aleksandrov 	struct nlmsghdr *nlh;
1846cf5bddb9SNikolay Aleksandrov 	struct sk_buff *skb;
1847cf5bddb9SNikolay Aleksandrov 	int err = -ENOBUFS;
1848cf5bddb9SNikolay Aleksandrov 	struct net *net;
1849cf5bddb9SNikolay Aleksandrov 	u16 flags = 0;
1850cf5bddb9SNikolay Aleksandrov 	int ifindex;
1851cf5bddb9SNikolay Aleksandrov 
1852cf5bddb9SNikolay Aleksandrov 	/* right now notifications are done only with rtnl held */
1853cf5bddb9SNikolay Aleksandrov 	ASSERT_RTNL();
1854cf5bddb9SNikolay Aleksandrov 
1855cf5bddb9SNikolay Aleksandrov 	if (p) {
1856cf5bddb9SNikolay Aleksandrov 		ifindex = p->dev->ifindex;
1857cf5bddb9SNikolay Aleksandrov 		vg = nbp_vlan_group(p);
1858cf5bddb9SNikolay Aleksandrov 		net = dev_net(p->dev);
1859cf5bddb9SNikolay Aleksandrov 	} else {
1860cf5bddb9SNikolay Aleksandrov 		ifindex = br->dev->ifindex;
1861cf5bddb9SNikolay Aleksandrov 		vg = br_vlan_group(br);
1862cf5bddb9SNikolay Aleksandrov 		net = dev_net(br->dev);
1863cf5bddb9SNikolay Aleksandrov 	}
1864cf5bddb9SNikolay Aleksandrov 
1865cf5bddb9SNikolay Aleksandrov 	skb = nlmsg_new(rtnl_vlan_nlmsg_size(), GFP_KERNEL);
1866cf5bddb9SNikolay Aleksandrov 	if (!skb)
1867cf5bddb9SNikolay Aleksandrov 		goto out_err;
1868cf5bddb9SNikolay Aleksandrov 
1869cf5bddb9SNikolay Aleksandrov 	err = -EMSGSIZE;
1870cf5bddb9SNikolay Aleksandrov 	nlh = nlmsg_put(skb, 0, 0, cmd, sizeof(*bvm), 0);
1871cf5bddb9SNikolay Aleksandrov 	if (!nlh)
1872cf5bddb9SNikolay Aleksandrov 		goto out_err;
1873cf5bddb9SNikolay Aleksandrov 	bvm = nlmsg_data(nlh);
1874cf5bddb9SNikolay Aleksandrov 	memset(bvm, 0, sizeof(*bvm));
1875cf5bddb9SNikolay Aleksandrov 	bvm->family = AF_BRIDGE;
1876cf5bddb9SNikolay Aleksandrov 	bvm->ifindex = ifindex;
1877cf5bddb9SNikolay Aleksandrov 
1878cf5bddb9SNikolay Aleksandrov 	switch (cmd) {
1879cf5bddb9SNikolay Aleksandrov 	case RTM_NEWVLAN:
1880cf5bddb9SNikolay Aleksandrov 		/* need to find the vlan due to flags/options */
1881cf5bddb9SNikolay Aleksandrov 		v = br_vlan_find(vg, vid);
1882cf5bddb9SNikolay Aleksandrov 		if (!v || !br_vlan_should_use(v))
1883cf5bddb9SNikolay Aleksandrov 			goto out_kfree;
1884cf5bddb9SNikolay Aleksandrov 
1885cf5bddb9SNikolay Aleksandrov 		flags = v->flags;
1886cf5bddb9SNikolay Aleksandrov 		if (br_get_pvid(vg) == v->vid)
1887cf5bddb9SNikolay Aleksandrov 			flags |= BRIDGE_VLAN_INFO_PVID;
1888cf5bddb9SNikolay Aleksandrov 		break;
1889cf5bddb9SNikolay Aleksandrov 	case RTM_DELVLAN:
1890cf5bddb9SNikolay Aleksandrov 		break;
1891cf5bddb9SNikolay Aleksandrov 	default:
1892cf5bddb9SNikolay Aleksandrov 		goto out_kfree;
1893cf5bddb9SNikolay Aleksandrov 	}
1894cf5bddb9SNikolay Aleksandrov 
189556d09976SNikolay Aleksandrov 	if (!br_vlan_fill_vids(skb, vid, vid_range, v, flags, false))
1896cf5bddb9SNikolay Aleksandrov 		goto out_err;
1897cf5bddb9SNikolay Aleksandrov 
1898cf5bddb9SNikolay Aleksandrov 	nlmsg_end(skb, nlh);
1899cf5bddb9SNikolay Aleksandrov 	rtnl_notify(skb, net, 0, RTNLGRP_BRVLAN, NULL, GFP_KERNEL);
1900cf5bddb9SNikolay Aleksandrov 	return;
1901cf5bddb9SNikolay Aleksandrov 
1902cf5bddb9SNikolay Aleksandrov out_err:
1903cf5bddb9SNikolay Aleksandrov 	rtnl_set_sk_err(net, RTNLGRP_BRVLAN, err);
1904cf5bddb9SNikolay Aleksandrov out_kfree:
1905cf5bddb9SNikolay Aleksandrov 	kfree_skb(skb);
1906cf5bddb9SNikolay Aleksandrov }
1907cf5bddb9SNikolay Aleksandrov 
19080ab55879SNikolay Aleksandrov /* check if v_curr can enter a range ending in range_end */
1909a5d29ae2SNikolay Aleksandrov bool br_vlan_can_enter_range(const struct net_bridge_vlan *v_curr,
19100ab55879SNikolay Aleksandrov 			     const struct net_bridge_vlan *range_end)
19110ab55879SNikolay Aleksandrov {
19120ab55879SNikolay Aleksandrov 	return v_curr->vid - range_end->vid == 1 &&
19137a53e718SNikolay Aleksandrov 	       range_end->flags == v_curr->flags &&
191499f7c5e0SNikolay Aleksandrov 	       br_vlan_opts_eq_range(v_curr, range_end);
19150ab55879SNikolay Aleksandrov }
19160ab55879SNikolay Aleksandrov 
19178dcea187SNikolay Aleksandrov static int br_vlan_dump_dev(const struct net_device *dev,
19188dcea187SNikolay Aleksandrov 			    struct sk_buff *skb,
191956d09976SNikolay Aleksandrov 			    struct netlink_callback *cb,
192056d09976SNikolay Aleksandrov 			    u32 dump_flags)
19218dcea187SNikolay Aleksandrov {
19220ab55879SNikolay Aleksandrov 	struct net_bridge_vlan *v, *range_start = NULL, *range_end = NULL;
1923743a53d9SNikolay Aleksandrov 	bool dump_global = !!(dump_flags & BRIDGE_VLANDB_DUMPF_GLOBAL);
192456d09976SNikolay Aleksandrov 	bool dump_stats = !!(dump_flags & BRIDGE_VLANDB_DUMPF_STATS);
19258dcea187SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
19268dcea187SNikolay Aleksandrov 	int idx = 0, s_idx = cb->args[1];
19278dcea187SNikolay Aleksandrov 	struct nlmsghdr *nlh = NULL;
19288dcea187SNikolay Aleksandrov 	struct net_bridge_port *p;
19298dcea187SNikolay Aleksandrov 	struct br_vlan_msg *bvm;
19308dcea187SNikolay Aleksandrov 	struct net_bridge *br;
19318dcea187SNikolay Aleksandrov 	int err = 0;
19328dcea187SNikolay Aleksandrov 	u16 pvid;
19338dcea187SNikolay Aleksandrov 
19348dcea187SNikolay Aleksandrov 	if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev))
19358dcea187SNikolay Aleksandrov 		return -EINVAL;
19368dcea187SNikolay Aleksandrov 
19378dcea187SNikolay Aleksandrov 	if (netif_is_bridge_master(dev)) {
19388dcea187SNikolay Aleksandrov 		br = netdev_priv(dev);
19398dcea187SNikolay Aleksandrov 		vg = br_vlan_group_rcu(br);
19408dcea187SNikolay Aleksandrov 		p = NULL;
19418dcea187SNikolay Aleksandrov 	} else {
1942743a53d9SNikolay Aleksandrov 		/* global options are dumped only for bridge devices */
1943743a53d9SNikolay Aleksandrov 		if (dump_global)
1944743a53d9SNikolay Aleksandrov 			return 0;
1945743a53d9SNikolay Aleksandrov 
19468dcea187SNikolay Aleksandrov 		p = br_port_get_rcu(dev);
19478dcea187SNikolay Aleksandrov 		if (WARN_ON(!p))
19488dcea187SNikolay Aleksandrov 			return -EINVAL;
19498dcea187SNikolay Aleksandrov 		vg = nbp_vlan_group_rcu(p);
19508dcea187SNikolay Aleksandrov 		br = p->br;
19518dcea187SNikolay Aleksandrov 	}
19528dcea187SNikolay Aleksandrov 
19538dcea187SNikolay Aleksandrov 	if (!vg)
19548dcea187SNikolay Aleksandrov 		return 0;
19558dcea187SNikolay Aleksandrov 
19568dcea187SNikolay Aleksandrov 	nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
19578dcea187SNikolay Aleksandrov 			RTM_NEWVLAN, sizeof(*bvm), NLM_F_MULTI);
19588dcea187SNikolay Aleksandrov 	if (!nlh)
19598dcea187SNikolay Aleksandrov 		return -EMSGSIZE;
19608dcea187SNikolay Aleksandrov 	bvm = nlmsg_data(nlh);
19618dcea187SNikolay Aleksandrov 	memset(bvm, 0, sizeof(*bvm));
19628dcea187SNikolay Aleksandrov 	bvm->family = PF_BRIDGE;
19638dcea187SNikolay Aleksandrov 	bvm->ifindex = dev->ifindex;
19648dcea187SNikolay Aleksandrov 	pvid = br_get_pvid(vg);
19658dcea187SNikolay Aleksandrov 
19660ab55879SNikolay Aleksandrov 	/* idx must stay at range's beginning until it is filled in */
19678dcea187SNikolay Aleksandrov 	list_for_each_entry_rcu(v, &vg->vlan_list, vlist) {
1968743a53d9SNikolay Aleksandrov 		if (!dump_global && !br_vlan_should_use(v))
19698dcea187SNikolay Aleksandrov 			continue;
19700ab55879SNikolay Aleksandrov 		if (idx < s_idx) {
19710ab55879SNikolay Aleksandrov 			idx++;
19720ab55879SNikolay Aleksandrov 			continue;
19730ab55879SNikolay Aleksandrov 		}
19740ab55879SNikolay Aleksandrov 
19750ab55879SNikolay Aleksandrov 		if (!range_start) {
19760ab55879SNikolay Aleksandrov 			range_start = v;
19770ab55879SNikolay Aleksandrov 			range_end = v;
19780ab55879SNikolay Aleksandrov 			continue;
19790ab55879SNikolay Aleksandrov 		}
19800ab55879SNikolay Aleksandrov 
1981743a53d9SNikolay Aleksandrov 		if (dump_global) {
1982743a53d9SNikolay Aleksandrov 			if (br_vlan_global_opts_can_enter_range(v, range_end))
19836c4110d9SNikolay Aleksandrov 				goto update_end;
1984743a53d9SNikolay Aleksandrov 			if (!br_vlan_global_opts_fill(skb, range_start->vid,
1985743a53d9SNikolay Aleksandrov 						      range_end->vid,
1986743a53d9SNikolay Aleksandrov 						      range_start)) {
1987743a53d9SNikolay Aleksandrov 				err = -EMSGSIZE;
1988743a53d9SNikolay Aleksandrov 				break;
1989743a53d9SNikolay Aleksandrov 			}
1990743a53d9SNikolay Aleksandrov 			/* advance number of filled vlans */
1991743a53d9SNikolay Aleksandrov 			idx += range_end->vid - range_start->vid + 1;
1992743a53d9SNikolay Aleksandrov 
1993743a53d9SNikolay Aleksandrov 			range_start = v;
1994743a53d9SNikolay Aleksandrov 		} else if (dump_stats || v->vid == pvid ||
199556d09976SNikolay Aleksandrov 			   !br_vlan_can_enter_range(v, range_end)) {
199656d09976SNikolay Aleksandrov 			u16 vlan_flags = br_vlan_flags(range_start, pvid);
19970ab55879SNikolay Aleksandrov 
19980ab55879SNikolay Aleksandrov 			if (!br_vlan_fill_vids(skb, range_start->vid,
19997a53e718SNikolay Aleksandrov 					       range_end->vid, range_start,
200056d09976SNikolay Aleksandrov 					       vlan_flags, dump_stats)) {
20018dcea187SNikolay Aleksandrov 				err = -EMSGSIZE;
20028dcea187SNikolay Aleksandrov 				break;
20038dcea187SNikolay Aleksandrov 			}
20040ab55879SNikolay Aleksandrov 			/* advance number of filled vlans */
20050ab55879SNikolay Aleksandrov 			idx += range_end->vid - range_start->vid + 1;
20060ab55879SNikolay Aleksandrov 
20070ab55879SNikolay Aleksandrov 			range_start = v;
20088dcea187SNikolay Aleksandrov 		}
20096c4110d9SNikolay Aleksandrov update_end:
20100ab55879SNikolay Aleksandrov 		range_end = v;
20110ab55879SNikolay Aleksandrov 	}
20120ab55879SNikolay Aleksandrov 
20130ab55879SNikolay Aleksandrov 	/* err will be 0 and range_start will be set in 3 cases here:
20140ab55879SNikolay Aleksandrov 	 * - first vlan (range_start == range_end)
20150ab55879SNikolay Aleksandrov 	 * - last vlan (range_start == range_end, not in range)
20160ab55879SNikolay Aleksandrov 	 * - last vlan range (range_start != range_end, in range)
20170ab55879SNikolay Aleksandrov 	 */
2018743a53d9SNikolay Aleksandrov 	if (!err && range_start) {
2019743a53d9SNikolay Aleksandrov 		if (dump_global &&
2020743a53d9SNikolay Aleksandrov 		    !br_vlan_global_opts_fill(skb, range_start->vid,
2021743a53d9SNikolay Aleksandrov 					      range_end->vid, range_start))
2022743a53d9SNikolay Aleksandrov 			err = -EMSGSIZE;
2023743a53d9SNikolay Aleksandrov 		else if (!dump_global &&
2024743a53d9SNikolay Aleksandrov 			 !br_vlan_fill_vids(skb, range_start->vid,
2025743a53d9SNikolay Aleksandrov 					    range_end->vid, range_start,
2026743a53d9SNikolay Aleksandrov 					    br_vlan_flags(range_start, pvid),
202756d09976SNikolay Aleksandrov 					    dump_stats))
20280ab55879SNikolay Aleksandrov 			err = -EMSGSIZE;
2029743a53d9SNikolay Aleksandrov 	}
20300ab55879SNikolay Aleksandrov 
20310ab55879SNikolay Aleksandrov 	cb->args[1] = err ? idx : 0;
20320ab55879SNikolay Aleksandrov 
20338dcea187SNikolay Aleksandrov 	nlmsg_end(skb, nlh);
20348dcea187SNikolay Aleksandrov 
20358dcea187SNikolay Aleksandrov 	return err;
20368dcea187SNikolay Aleksandrov }
20378dcea187SNikolay Aleksandrov 
203856d09976SNikolay Aleksandrov static const struct nla_policy br_vlan_db_dump_pol[BRIDGE_VLANDB_DUMP_MAX + 1] = {
203956d09976SNikolay Aleksandrov 	[BRIDGE_VLANDB_DUMP_FLAGS] = { .type = NLA_U32 },
204056d09976SNikolay Aleksandrov };
204156d09976SNikolay Aleksandrov 
20428dcea187SNikolay Aleksandrov static int br_vlan_rtm_dump(struct sk_buff *skb, struct netlink_callback *cb)
20438dcea187SNikolay Aleksandrov {
204456d09976SNikolay Aleksandrov 	struct nlattr *dtb[BRIDGE_VLANDB_DUMP_MAX + 1];
20458dcea187SNikolay Aleksandrov 	int idx = 0, err = 0, s_idx = cb->args[0];
20468dcea187SNikolay Aleksandrov 	struct net *net = sock_net(skb->sk);
20478dcea187SNikolay Aleksandrov 	struct br_vlan_msg *bvm;
20488dcea187SNikolay Aleksandrov 	struct net_device *dev;
204956d09976SNikolay Aleksandrov 	u32 dump_flags = 0;
20508dcea187SNikolay Aleksandrov 
205156d09976SNikolay Aleksandrov 	err = nlmsg_parse(cb->nlh, sizeof(*bvm), dtb, BRIDGE_VLANDB_DUMP_MAX,
205256d09976SNikolay Aleksandrov 			  br_vlan_db_dump_pol, cb->extack);
20538dcea187SNikolay Aleksandrov 	if (err < 0)
20548dcea187SNikolay Aleksandrov 		return err;
20558dcea187SNikolay Aleksandrov 
20568dcea187SNikolay Aleksandrov 	bvm = nlmsg_data(cb->nlh);
205756d09976SNikolay Aleksandrov 	if (dtb[BRIDGE_VLANDB_DUMP_FLAGS])
205856d09976SNikolay Aleksandrov 		dump_flags = nla_get_u32(dtb[BRIDGE_VLANDB_DUMP_FLAGS]);
20598dcea187SNikolay Aleksandrov 
20608dcea187SNikolay Aleksandrov 	rcu_read_lock();
20618dcea187SNikolay Aleksandrov 	if (bvm->ifindex) {
20628dcea187SNikolay Aleksandrov 		dev = dev_get_by_index_rcu(net, bvm->ifindex);
20638dcea187SNikolay Aleksandrov 		if (!dev) {
20648dcea187SNikolay Aleksandrov 			err = -ENODEV;
20658dcea187SNikolay Aleksandrov 			goto out_err;
20668dcea187SNikolay Aleksandrov 		}
206756d09976SNikolay Aleksandrov 		err = br_vlan_dump_dev(dev, skb, cb, dump_flags);
2068dcb2c5c6SNikolay Aleksandrov 		/* if the dump completed without an error we return 0 here */
2069dcb2c5c6SNikolay Aleksandrov 		if (err != -EMSGSIZE)
20708dcea187SNikolay Aleksandrov 			goto out_err;
20718dcea187SNikolay Aleksandrov 	} else {
20728dcea187SNikolay Aleksandrov 		for_each_netdev_rcu(net, dev) {
20738dcea187SNikolay Aleksandrov 			if (idx < s_idx)
20748dcea187SNikolay Aleksandrov 				goto skip;
20758dcea187SNikolay Aleksandrov 
207656d09976SNikolay Aleksandrov 			err = br_vlan_dump_dev(dev, skb, cb, dump_flags);
20778dcea187SNikolay Aleksandrov 			if (err == -EMSGSIZE)
20788dcea187SNikolay Aleksandrov 				break;
20798dcea187SNikolay Aleksandrov skip:
20808dcea187SNikolay Aleksandrov 			idx++;
20818dcea187SNikolay Aleksandrov 		}
20828dcea187SNikolay Aleksandrov 	}
20838dcea187SNikolay Aleksandrov 	cb->args[0] = idx;
20848dcea187SNikolay Aleksandrov 	rcu_read_unlock();
20858dcea187SNikolay Aleksandrov 
20868dcea187SNikolay Aleksandrov 	return skb->len;
20878dcea187SNikolay Aleksandrov 
20888dcea187SNikolay Aleksandrov out_err:
20898dcea187SNikolay Aleksandrov 	rcu_read_unlock();
20908dcea187SNikolay Aleksandrov 
20918dcea187SNikolay Aleksandrov 	return err;
20928dcea187SNikolay Aleksandrov }
20938dcea187SNikolay Aleksandrov 
2094f26b2965SNikolay Aleksandrov static const struct nla_policy br_vlan_db_policy[BRIDGE_VLANDB_ENTRY_MAX + 1] = {
20958140860cSJohannes Berg 	[BRIDGE_VLANDB_ENTRY_INFO]	=
20968140860cSJohannes Berg 		NLA_POLICY_EXACT_LEN(sizeof(struct bridge_vlan_info)),
20970ab55879SNikolay Aleksandrov 	[BRIDGE_VLANDB_ENTRY_RANGE]	= { .type = NLA_U16 },
2098a580c76dSNikolay Aleksandrov 	[BRIDGE_VLANDB_ENTRY_STATE]	= { .type = NLA_U8 },
2099fa388f29SNikolay Aleksandrov 	[BRIDGE_VLANDB_ENTRY_TUNNEL_INFO] = { .type = NLA_NESTED },
21002796d846SNikolay Aleksandrov 	[BRIDGE_VLANDB_ENTRY_MCAST_ROUTER]	= { .type = NLA_U8 },
2101f26b2965SNikolay Aleksandrov };
2102f26b2965SNikolay Aleksandrov 
2103f26b2965SNikolay Aleksandrov static int br_vlan_rtm_process_one(struct net_device *dev,
2104f26b2965SNikolay Aleksandrov 				   const struct nlattr *attr,
2105f26b2965SNikolay Aleksandrov 				   int cmd, struct netlink_ext_ack *extack)
2106f26b2965SNikolay Aleksandrov {
21070ab55879SNikolay Aleksandrov 	struct bridge_vlan_info *vinfo, vrange_end, *vinfo_last = NULL;
2108f26b2965SNikolay Aleksandrov 	struct nlattr *tb[BRIDGE_VLANDB_ENTRY_MAX + 1];
2109a5d29ae2SNikolay Aleksandrov 	bool changed = false, skip_processing = false;
2110f26b2965SNikolay Aleksandrov 	struct net_bridge_vlan_group *vg;
2111f26b2965SNikolay Aleksandrov 	struct net_bridge_port *p = NULL;
2112f26b2965SNikolay Aleksandrov 	int err = 0, cmdmap = 0;
2113f26b2965SNikolay Aleksandrov 	struct net_bridge *br;
2114f26b2965SNikolay Aleksandrov 
2115f26b2965SNikolay Aleksandrov 	if (netif_is_bridge_master(dev)) {
2116f26b2965SNikolay Aleksandrov 		br = netdev_priv(dev);
2117f26b2965SNikolay Aleksandrov 		vg = br_vlan_group(br);
2118f26b2965SNikolay Aleksandrov 	} else {
2119f26b2965SNikolay Aleksandrov 		p = br_port_get_rtnl(dev);
2120f26b2965SNikolay Aleksandrov 		if (WARN_ON(!p))
2121f26b2965SNikolay Aleksandrov 			return -ENODEV;
2122f26b2965SNikolay Aleksandrov 		br = p->br;
2123f26b2965SNikolay Aleksandrov 		vg = nbp_vlan_group(p);
2124f26b2965SNikolay Aleksandrov 	}
2125f26b2965SNikolay Aleksandrov 
2126f26b2965SNikolay Aleksandrov 	if (WARN_ON(!vg))
2127f26b2965SNikolay Aleksandrov 		return -ENODEV;
2128f26b2965SNikolay Aleksandrov 
2129f26b2965SNikolay Aleksandrov 	err = nla_parse_nested(tb, BRIDGE_VLANDB_ENTRY_MAX, attr,
2130f26b2965SNikolay Aleksandrov 			       br_vlan_db_policy, extack);
2131f26b2965SNikolay Aleksandrov 	if (err)
2132f26b2965SNikolay Aleksandrov 		return err;
2133f26b2965SNikolay Aleksandrov 
2134f26b2965SNikolay Aleksandrov 	if (!tb[BRIDGE_VLANDB_ENTRY_INFO]) {
2135f26b2965SNikolay Aleksandrov 		NL_SET_ERR_MSG_MOD(extack, "Missing vlan entry info");
2136f26b2965SNikolay Aleksandrov 		return -EINVAL;
2137f26b2965SNikolay Aleksandrov 	}
21380ab55879SNikolay Aleksandrov 	memset(&vrange_end, 0, sizeof(vrange_end));
2139f26b2965SNikolay Aleksandrov 
2140f26b2965SNikolay Aleksandrov 	vinfo = nla_data(tb[BRIDGE_VLANDB_ENTRY_INFO]);
2141f26b2965SNikolay Aleksandrov 	if (vinfo->flags & (BRIDGE_VLAN_INFO_RANGE_BEGIN |
2142f26b2965SNikolay Aleksandrov 			    BRIDGE_VLAN_INFO_RANGE_END)) {
2143f26b2965SNikolay Aleksandrov 		NL_SET_ERR_MSG_MOD(extack, "Old-style vlan ranges are not allowed when using RTM vlan calls");
2144f26b2965SNikolay Aleksandrov 		return -EINVAL;
2145f26b2965SNikolay Aleksandrov 	}
2146f26b2965SNikolay Aleksandrov 	if (!br_vlan_valid_id(vinfo->vid, extack))
2147f26b2965SNikolay Aleksandrov 		return -EINVAL;
2148f26b2965SNikolay Aleksandrov 
21490ab55879SNikolay Aleksandrov 	if (tb[BRIDGE_VLANDB_ENTRY_RANGE]) {
21500ab55879SNikolay Aleksandrov 		vrange_end.vid = nla_get_u16(tb[BRIDGE_VLANDB_ENTRY_RANGE]);
21510ab55879SNikolay Aleksandrov 		/* validate user-provided flags without RANGE_BEGIN */
21520ab55879SNikolay Aleksandrov 		vrange_end.flags = BRIDGE_VLAN_INFO_RANGE_END | vinfo->flags;
21530ab55879SNikolay Aleksandrov 		vinfo->flags |= BRIDGE_VLAN_INFO_RANGE_BEGIN;
21540ab55879SNikolay Aleksandrov 
21550ab55879SNikolay Aleksandrov 		/* vinfo_last is the range start, vinfo the range end */
21560ab55879SNikolay Aleksandrov 		vinfo_last = vinfo;
21570ab55879SNikolay Aleksandrov 		vinfo = &vrange_end;
21580ab55879SNikolay Aleksandrov 
21590ab55879SNikolay Aleksandrov 		if (!br_vlan_valid_id(vinfo->vid, extack) ||
21600ab55879SNikolay Aleksandrov 		    !br_vlan_valid_range(vinfo, vinfo_last, extack))
21610ab55879SNikolay Aleksandrov 			return -EINVAL;
21620ab55879SNikolay Aleksandrov 	}
21630ab55879SNikolay Aleksandrov 
2164f26b2965SNikolay Aleksandrov 	switch (cmd) {
2165f26b2965SNikolay Aleksandrov 	case RTM_NEWVLAN:
2166f26b2965SNikolay Aleksandrov 		cmdmap = RTM_SETLINK;
2167a5d29ae2SNikolay Aleksandrov 		skip_processing = !!(vinfo->flags & BRIDGE_VLAN_INFO_ONLY_OPTS);
2168f26b2965SNikolay Aleksandrov 		break;
2169adb3ce9bSNikolay Aleksandrov 	case RTM_DELVLAN:
2170adb3ce9bSNikolay Aleksandrov 		cmdmap = RTM_DELLINK;
2171adb3ce9bSNikolay Aleksandrov 		break;
2172f26b2965SNikolay Aleksandrov 	}
2173f26b2965SNikolay Aleksandrov 
2174a5d29ae2SNikolay Aleksandrov 	if (!skip_processing) {
2175a5d29ae2SNikolay Aleksandrov 		struct bridge_vlan_info *tmp_last = vinfo_last;
2176a5d29ae2SNikolay Aleksandrov 
2177a5d29ae2SNikolay Aleksandrov 		/* br_process_vlan_info may overwrite vinfo_last */
2178a5d29ae2SNikolay Aleksandrov 		err = br_process_vlan_info(br, p, cmdmap, vinfo, &tmp_last,
2179a5d29ae2SNikolay Aleksandrov 					   &changed, extack);
2180a5d29ae2SNikolay Aleksandrov 
2181a5d29ae2SNikolay Aleksandrov 		/* notify first if anything changed */
2182f26b2965SNikolay Aleksandrov 		if (changed)
2183f26b2965SNikolay Aleksandrov 			br_ifinfo_notify(cmdmap, br, p);
2184f26b2965SNikolay Aleksandrov 
2185a5d29ae2SNikolay Aleksandrov 		if (err)
2186a5d29ae2SNikolay Aleksandrov 			return err;
2187a5d29ae2SNikolay Aleksandrov 	}
2188a5d29ae2SNikolay Aleksandrov 
2189a5d29ae2SNikolay Aleksandrov 	/* deal with options */
2190a5d29ae2SNikolay Aleksandrov 	if (cmd == RTM_NEWVLAN) {
2191a5d29ae2SNikolay Aleksandrov 		struct net_bridge_vlan *range_start, *range_end;
2192a5d29ae2SNikolay Aleksandrov 
2193a5d29ae2SNikolay Aleksandrov 		if (vinfo_last) {
2194a5d29ae2SNikolay Aleksandrov 			range_start = br_vlan_find(vg, vinfo_last->vid);
2195a5d29ae2SNikolay Aleksandrov 			range_end = br_vlan_find(vg, vinfo->vid);
2196a5d29ae2SNikolay Aleksandrov 		} else {
2197a5d29ae2SNikolay Aleksandrov 			range_start = br_vlan_find(vg, vinfo->vid);
2198a5d29ae2SNikolay Aleksandrov 			range_end = range_start;
2199a5d29ae2SNikolay Aleksandrov 		}
2200a5d29ae2SNikolay Aleksandrov 
2201a5d29ae2SNikolay Aleksandrov 		err = br_vlan_process_options(br, p, range_start, range_end,
2202a5d29ae2SNikolay Aleksandrov 					      tb, extack);
2203a5d29ae2SNikolay Aleksandrov 	}
2204a5d29ae2SNikolay Aleksandrov 
2205f26b2965SNikolay Aleksandrov 	return err;
2206f26b2965SNikolay Aleksandrov }
2207f26b2965SNikolay Aleksandrov 
2208f26b2965SNikolay Aleksandrov static int br_vlan_rtm_process(struct sk_buff *skb, struct nlmsghdr *nlh,
2209f26b2965SNikolay Aleksandrov 			       struct netlink_ext_ack *extack)
2210f26b2965SNikolay Aleksandrov {
2211f26b2965SNikolay Aleksandrov 	struct net *net = sock_net(skb->sk);
2212f26b2965SNikolay Aleksandrov 	struct br_vlan_msg *bvm;
2213f26b2965SNikolay Aleksandrov 	struct net_device *dev;
2214f26b2965SNikolay Aleksandrov 	struct nlattr *attr;
2215f26b2965SNikolay Aleksandrov 	int err, vlans = 0;
2216f26b2965SNikolay Aleksandrov 	int rem;
2217f26b2965SNikolay Aleksandrov 
2218f26b2965SNikolay Aleksandrov 	/* this should validate the header and check for remaining bytes */
2219f26b2965SNikolay Aleksandrov 	err = nlmsg_parse(nlh, sizeof(*bvm), NULL, BRIDGE_VLANDB_MAX, NULL,
2220f26b2965SNikolay Aleksandrov 			  extack);
2221f26b2965SNikolay Aleksandrov 	if (err < 0)
2222f26b2965SNikolay Aleksandrov 		return err;
2223f26b2965SNikolay Aleksandrov 
2224f26b2965SNikolay Aleksandrov 	bvm = nlmsg_data(nlh);
2225f26b2965SNikolay Aleksandrov 	dev = __dev_get_by_index(net, bvm->ifindex);
2226f26b2965SNikolay Aleksandrov 	if (!dev)
2227f26b2965SNikolay Aleksandrov 		return -ENODEV;
2228f26b2965SNikolay Aleksandrov 
2229f26b2965SNikolay Aleksandrov 	if (!netif_is_bridge_master(dev) && !netif_is_bridge_port(dev)) {
2230f26b2965SNikolay Aleksandrov 		NL_SET_ERR_MSG_MOD(extack, "The device is not a valid bridge or bridge port");
2231f26b2965SNikolay Aleksandrov 		return -EINVAL;
2232f26b2965SNikolay Aleksandrov 	}
2233f26b2965SNikolay Aleksandrov 
2234f26b2965SNikolay Aleksandrov 	nlmsg_for_each_attr(attr, nlh, sizeof(*bvm), rem) {
223547ecd2dbSNikolay Aleksandrov 		switch (nla_type(attr)) {
223647ecd2dbSNikolay Aleksandrov 		case BRIDGE_VLANDB_ENTRY:
223747ecd2dbSNikolay Aleksandrov 			err = br_vlan_rtm_process_one(dev, attr,
223847ecd2dbSNikolay Aleksandrov 						      nlh->nlmsg_type,
223947ecd2dbSNikolay Aleksandrov 						      extack);
224047ecd2dbSNikolay Aleksandrov 			break;
224147ecd2dbSNikolay Aleksandrov 		case BRIDGE_VLANDB_GLOBAL_OPTIONS:
224247ecd2dbSNikolay Aleksandrov 			err = br_vlan_rtm_process_global_options(dev, attr,
224347ecd2dbSNikolay Aleksandrov 								 nlh->nlmsg_type,
224447ecd2dbSNikolay Aleksandrov 								 extack);
224547ecd2dbSNikolay Aleksandrov 			break;
224647ecd2dbSNikolay Aleksandrov 		default:
2247f26b2965SNikolay Aleksandrov 			continue;
224847ecd2dbSNikolay Aleksandrov 		}
2249f26b2965SNikolay Aleksandrov 
2250f26b2965SNikolay Aleksandrov 		vlans++;
2251f26b2965SNikolay Aleksandrov 		if (err)
2252f26b2965SNikolay Aleksandrov 			break;
2253f26b2965SNikolay Aleksandrov 	}
2254f26b2965SNikolay Aleksandrov 	if (!vlans) {
2255f26b2965SNikolay Aleksandrov 		NL_SET_ERR_MSG_MOD(extack, "No vlans found to process");
2256f26b2965SNikolay Aleksandrov 		err = -EINVAL;
2257f26b2965SNikolay Aleksandrov 	}
2258f26b2965SNikolay Aleksandrov 
2259f26b2965SNikolay Aleksandrov 	return err;
2260f26b2965SNikolay Aleksandrov }
2261f26b2965SNikolay Aleksandrov 
22628dcea187SNikolay Aleksandrov void br_vlan_rtnl_init(void)
22638dcea187SNikolay Aleksandrov {
22648dcea187SNikolay Aleksandrov 	rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_GETVLAN, NULL,
22658dcea187SNikolay Aleksandrov 			     br_vlan_rtm_dump, 0);
2266f26b2965SNikolay Aleksandrov 	rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_NEWVLAN,
2267f26b2965SNikolay Aleksandrov 			     br_vlan_rtm_process, NULL, 0);
2268adb3ce9bSNikolay Aleksandrov 	rtnl_register_module(THIS_MODULE, PF_BRIDGE, RTM_DELVLAN,
2269adb3ce9bSNikolay Aleksandrov 			     br_vlan_rtm_process, NULL, 0);
22708dcea187SNikolay Aleksandrov }
22718dcea187SNikolay Aleksandrov 
22728dcea187SNikolay Aleksandrov void br_vlan_rtnl_uninit(void)
22738dcea187SNikolay Aleksandrov {
22748dcea187SNikolay Aleksandrov 	rtnl_unregister(PF_BRIDGE, RTM_GETVLAN);
2275f26b2965SNikolay Aleksandrov 	rtnl_unregister(PF_BRIDGE, RTM_NEWVLAN);
2276adb3ce9bSNikolay Aleksandrov 	rtnl_unregister(PF_BRIDGE, RTM_DELVLAN);
22778dcea187SNikolay Aleksandrov }
2278