xref: /openbmc/linux/net/bridge/br_switchdev.c (revision a83856bd)
1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
26bc506b4SIdo Schimmel #include <linux/kernel.h>
36bc506b4SIdo Schimmel #include <linux/list.h>
46bc506b4SIdo Schimmel #include <linux/netdevice.h>
56bc506b4SIdo Schimmel #include <linux/rtnetlink.h>
66bc506b4SIdo Schimmel #include <linux/skbuff.h>
79776457cSVladimir Oltean #include <net/ip.h>
86bc506b4SIdo Schimmel #include <net/switchdev.h>
96bc506b4SIdo Schimmel 
106bc506b4SIdo Schimmel #include "br_private.h"
116bc506b4SIdo Schimmel 
1247211192STobias Waldekranz static struct static_key_false br_switchdev_tx_fwd_offload;
1347211192STobias Waldekranz 
nbp_switchdev_can_offload_tx_fwd(const struct net_bridge_port * p,const struct sk_buff * skb)1447211192STobias Waldekranz static bool nbp_switchdev_can_offload_tx_fwd(const struct net_bridge_port *p,
1547211192STobias Waldekranz 					     const struct sk_buff *skb)
1647211192STobias Waldekranz {
1747211192STobias Waldekranz 	if (!static_branch_unlikely(&br_switchdev_tx_fwd_offload))
1847211192STobias Waldekranz 		return false;
1947211192STobias Waldekranz 
2047211192STobias Waldekranz 	return (p->flags & BR_TX_FWD_OFFLOAD) &&
2147211192STobias Waldekranz 	       (p->hwdom != BR_INPUT_SKB_CB(skb)->src_hwdom);
2247211192STobias Waldekranz }
2347211192STobias Waldekranz 
br_switchdev_frame_uses_tx_fwd_offload(struct sk_buff * skb)2447211192STobias Waldekranz bool br_switchdev_frame_uses_tx_fwd_offload(struct sk_buff *skb)
2547211192STobias Waldekranz {
2647211192STobias Waldekranz 	if (!static_branch_unlikely(&br_switchdev_tx_fwd_offload))
2747211192STobias Waldekranz 		return false;
2847211192STobias Waldekranz 
2947211192STobias Waldekranz 	return BR_INPUT_SKB_CB(skb)->tx_fwd_offload;
3047211192STobias Waldekranz }
3147211192STobias Waldekranz 
br_switchdev_frame_set_offload_fwd_mark(struct sk_buff * skb)32c5381154SVladimir Oltean void br_switchdev_frame_set_offload_fwd_mark(struct sk_buff *skb)
33c5381154SVladimir Oltean {
34c5381154SVladimir Oltean 	skb->offload_fwd_mark = br_switchdev_frame_uses_tx_fwd_offload(skb);
35c5381154SVladimir Oltean }
36c5381154SVladimir Oltean 
3747211192STobias Waldekranz /* Mark the frame for TX forwarding offload if this egress port supports it */
nbp_switchdev_frame_mark_tx_fwd_offload(const struct net_bridge_port * p,struct sk_buff * skb)3847211192STobias Waldekranz void nbp_switchdev_frame_mark_tx_fwd_offload(const struct net_bridge_port *p,
3947211192STobias Waldekranz 					     struct sk_buff *skb)
4047211192STobias Waldekranz {
4147211192STobias Waldekranz 	if (nbp_switchdev_can_offload_tx_fwd(p, skb))
4247211192STobias Waldekranz 		BR_INPUT_SKB_CB(skb)->tx_fwd_offload = true;
4347211192STobias Waldekranz }
4447211192STobias Waldekranz 
4547211192STobias Waldekranz /* Lazily adds the hwdom of the egress bridge port to the bit mask of hwdoms
4647211192STobias Waldekranz  * that the skb has been already forwarded to, to avoid further cloning to
4747211192STobias Waldekranz  * other ports in the same hwdom by making nbp_switchdev_allowed_egress()
4847211192STobias Waldekranz  * return false.
4947211192STobias Waldekranz  */
nbp_switchdev_frame_mark_tx_fwd_to_hwdom(const struct net_bridge_port * p,struct sk_buff * skb)5047211192STobias Waldekranz void nbp_switchdev_frame_mark_tx_fwd_to_hwdom(const struct net_bridge_port *p,
5147211192STobias Waldekranz 					      struct sk_buff *skb)
5247211192STobias Waldekranz {
5347211192STobias Waldekranz 	if (nbp_switchdev_can_offload_tx_fwd(p, skb))
5447211192STobias Waldekranz 		set_bit(p->hwdom, &BR_INPUT_SKB_CB(skb)->fwd_hwdoms);
5547211192STobias Waldekranz }
5647211192STobias Waldekranz 
nbp_switchdev_frame_mark(const struct net_bridge_port * p,struct sk_buff * skb)576bc506b4SIdo Schimmel void nbp_switchdev_frame_mark(const struct net_bridge_port *p,
586bc506b4SIdo Schimmel 			      struct sk_buff *skb)
596bc506b4SIdo Schimmel {
60f7cf972fSTobias Waldekranz 	if (p->hwdom)
61f7cf972fSTobias Waldekranz 		BR_INPUT_SKB_CB(skb)->src_hwdom = p->hwdom;
626bc506b4SIdo Schimmel }
636bc506b4SIdo Schimmel 
nbp_switchdev_allowed_egress(const struct net_bridge_port * p,const struct sk_buff * skb)646bc506b4SIdo Schimmel bool nbp_switchdev_allowed_egress(const struct net_bridge_port *p,
656bc506b4SIdo Schimmel 				  const struct sk_buff *skb)
666bc506b4SIdo Schimmel {
6747211192STobias Waldekranz 	struct br_input_skb_cb *cb = BR_INPUT_SKB_CB(skb);
6847211192STobias Waldekranz 
6947211192STobias Waldekranz 	return !test_bit(p->hwdom, &cb->fwd_hwdoms) &&
7047211192STobias Waldekranz 		(!skb->offload_fwd_mark || cb->src_hwdom != p->hwdom);
716bc506b4SIdo Schimmel }
723922285dSArkadi Sharshevsky 
733922285dSArkadi Sharshevsky /* Flags that can be offloaded to hardware */
749c0ca02bSIdo Schimmel #define BR_PORT_FLAGS_HW_OFFLOAD (BR_LEARNING | BR_FLOOD | BR_PORT_MAB | \
75c3976a3fSArınç ÜNAL 				  BR_MCAST_FLOOD | BR_BCAST_FLOOD | BR_PORT_LOCKED | \
76c3976a3fSArınç ÜNAL 				  BR_HAIRPIN_MODE | BR_ISOLATED | BR_MULTICAST_TO_UNICAST)
773922285dSArkadi Sharshevsky 
br_switchdev_set_port_flag(struct net_bridge_port * p,unsigned long flags,unsigned long mask,struct netlink_ext_ack * extack)783922285dSArkadi Sharshevsky int br_switchdev_set_port_flag(struct net_bridge_port *p,
793922285dSArkadi Sharshevsky 			       unsigned long flags,
80078bbb85SVladimir Oltean 			       unsigned long mask,
81078bbb85SVladimir Oltean 			       struct netlink_ext_ack *extack)
823922285dSArkadi Sharshevsky {
833922285dSArkadi Sharshevsky 	struct switchdev_attr attr = {
843922285dSArkadi Sharshevsky 		.orig_dev = p->dev,
853922285dSArkadi Sharshevsky 	};
86d45224d6SFlorian Fainelli 	struct switchdev_notifier_port_attr_info info = {
87d45224d6SFlorian Fainelli 		.attr = &attr,
88d45224d6SFlorian Fainelli 	};
893922285dSArkadi Sharshevsky 	int err;
903922285dSArkadi Sharshevsky 
91304ae3bfSVladimir Oltean 	mask &= BR_PORT_FLAGS_HW_OFFLOAD;
92304ae3bfSVladimir Oltean 	if (!mask)
933922285dSArkadi Sharshevsky 		return 0;
943922285dSArkadi Sharshevsky 
95e18f4c18SVladimir Oltean 	attr.id = SWITCHDEV_ATTR_ID_PORT_PRE_BRIDGE_FLAGS;
96e18f4c18SVladimir Oltean 	attr.u.brport_flags.val = flags;
97e18f4c18SVladimir Oltean 	attr.u.brport_flags.mask = mask;
98304ae3bfSVladimir Oltean 
99d45224d6SFlorian Fainelli 	/* We run from atomic context here */
100d45224d6SFlorian Fainelli 	err = call_switchdev_notifiers(SWITCHDEV_PORT_ATTR_SET, p->dev,
101078bbb85SVladimir Oltean 				       &info.info, extack);
102d45224d6SFlorian Fainelli 	err = notifier_to_errno(err);
1033922285dSArkadi Sharshevsky 	if (err == -EOPNOTSUPP)
1043922285dSArkadi Sharshevsky 		return 0;
1053922285dSArkadi Sharshevsky 
1061ef07644SFlorian Fainelli 	if (err) {
107028fb19cSLeon Romanovsky 		NL_SET_ERR_MSG_WEAK_MOD(extack,
108078bbb85SVladimir Oltean 					"bridge flag offload is not supported");
1093922285dSArkadi Sharshevsky 		return -EOPNOTSUPP;
1103922285dSArkadi Sharshevsky 	}
1113922285dSArkadi Sharshevsky 
1123922285dSArkadi Sharshevsky 	attr.id = SWITCHDEV_ATTR_ID_PORT_BRIDGE_FLAGS;
1133922285dSArkadi Sharshevsky 	attr.flags = SWITCHDEV_F_DEFER;
1141ef07644SFlorian Fainelli 
115dcbdf135SVladimir Oltean 	err = switchdev_port_attr_set(p->dev, &attr, extack);
1163922285dSArkadi Sharshevsky 	if (err) {
117028fb19cSLeon Romanovsky 		NL_SET_ERR_MSG_WEAK_MOD(extack,
118dcbdf135SVladimir Oltean 					"error setting offload flag on port");
1193922285dSArkadi Sharshevsky 		return err;
1203922285dSArkadi Sharshevsky 	}
1213922285dSArkadi Sharshevsky 
1223922285dSArkadi Sharshevsky 	return 0;
1233922285dSArkadi Sharshevsky }
1246b26b51bSArkadi Sharshevsky 
br_switchdev_fdb_populate(struct net_bridge * br,struct switchdev_notifier_fdb_info * item,const struct net_bridge_fdb_entry * fdb,const void * ctx)125fab9eca8SVladimir Oltean static void br_switchdev_fdb_populate(struct net_bridge *br,
126fab9eca8SVladimir Oltean 				      struct switchdev_notifier_fdb_info *item,
127fab9eca8SVladimir Oltean 				      const struct net_bridge_fdb_entry *fdb,
128fab9eca8SVladimir Oltean 				      const void *ctx)
129fab9eca8SVladimir Oltean {
130fab9eca8SVladimir Oltean 	const struct net_bridge_port *p = READ_ONCE(fdb->dst);
131fab9eca8SVladimir Oltean 
132fab9eca8SVladimir Oltean 	item->addr = fdb->key.addr.addr;
133fab9eca8SVladimir Oltean 	item->vid = fdb->key.vlan_id;
134fab9eca8SVladimir Oltean 	item->added_by_user = test_bit(BR_FDB_ADDED_BY_USER, &fdb->flags);
135fab9eca8SVladimir Oltean 	item->offloaded = test_bit(BR_FDB_OFFLOADED, &fdb->flags);
136fab9eca8SVladimir Oltean 	item->is_local = test_bit(BR_FDB_LOCAL, &fdb->flags);
13727fabd02SHans J. Schultz 	item->locked = false;
138fab9eca8SVladimir Oltean 	item->info.dev = (!p || item->is_local) ? br->dev : p->dev;
139fab9eca8SVladimir Oltean 	item->info.ctx = ctx;
140fab9eca8SVladimir Oltean }
141fab9eca8SVladimir Oltean 
1426b26b51bSArkadi Sharshevsky void
br_switchdev_fdb_notify(struct net_bridge * br,const struct net_bridge_fdb_entry * fdb,int type)1436eb38bf8STobias Waldekranz br_switchdev_fdb_notify(struct net_bridge *br,
1446eb38bf8STobias Waldekranz 			const struct net_bridge_fdb_entry *fdb, int type)
1456b26b51bSArkadi Sharshevsky {
146fab9eca8SVladimir Oltean 	struct switchdev_notifier_fdb_info item;
147fab9eca8SVladimir Oltean 
14827fabd02SHans J. Schultz 	if (test_bit(BR_FDB_LOCKED, &fdb->flags))
14927fabd02SHans J. Schultz 		return;
15027fabd02SHans J. Schultz 
151927cdea5SVladimir Oltean 	/* Entries with these flags were created using ndm_state == NUD_REACHABLE,
152927cdea5SVladimir Oltean 	 * ndm_flags == NTF_MASTER( | NTF_STICKY), ext_flags == 0 by something
153927cdea5SVladimir Oltean 	 * equivalent to 'bridge fdb add ... master dynamic (sticky)'.
154927cdea5SVladimir Oltean 	 * Drivers don't know how to deal with these, so don't notify them to
155927cdea5SVladimir Oltean 	 * avoid confusing them.
156927cdea5SVladimir Oltean 	 */
157927cdea5SVladimir Oltean 	if (test_bit(BR_FDB_ADDED_BY_USER, &fdb->flags) &&
158927cdea5SVladimir Oltean 	    !test_bit(BR_FDB_STATIC, &fdb->flags) &&
159927cdea5SVladimir Oltean 	    !test_bit(BR_FDB_ADDED_BY_EXT_LEARN, &fdb->flags))
160927cdea5SVladimir Oltean 		return;
161927cdea5SVladimir Oltean 
162fab9eca8SVladimir Oltean 	br_switchdev_fdb_populate(br, &item, fdb, NULL);
163e5b4b898STobias Waldekranz 
1646b26b51bSArkadi Sharshevsky 	switch (type) {
1656b26b51bSArkadi Sharshevsky 	case RTM_DELNEIGH:
166e5b4b898STobias Waldekranz 		call_switchdev_notifiers(SWITCHDEV_FDB_DEL_TO_DEVICE,
167fab9eca8SVladimir Oltean 					 item.info.dev, &item.info, NULL);
1686b26b51bSArkadi Sharshevsky 		break;
1696b26b51bSArkadi Sharshevsky 	case RTM_NEWNEIGH:
170e5b4b898STobias Waldekranz 		call_switchdev_notifiers(SWITCHDEV_FDB_ADD_TO_DEVICE,
171fab9eca8SVladimir Oltean 					 item.info.dev, &item.info, NULL);
1726b26b51bSArkadi Sharshevsky 		break;
1736b26b51bSArkadi Sharshevsky 	}
1746b26b51bSArkadi Sharshevsky }
175d66e4348SPetr Machata 
br_switchdev_port_vlan_add(struct net_device * dev,u16 vid,u16 flags,bool changed,struct netlink_ext_ack * extack)176169327d5SPetr Machata int br_switchdev_port_vlan_add(struct net_device *dev, u16 vid, u16 flags,
1778d23a54fSVladimir Oltean 			       bool changed, struct netlink_ext_ack *extack)
178d66e4348SPetr Machata {
179d66e4348SPetr Machata 	struct switchdev_obj_port_vlan v = {
180d66e4348SPetr Machata 		.obj.orig_dev = dev,
181d66e4348SPetr Machata 		.obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
182d66e4348SPetr Machata 		.flags = flags,
183b7a9e0daSVladimir Oltean 		.vid = vid,
1848d23a54fSVladimir Oltean 		.changed = changed,
185d66e4348SPetr Machata 	};
186d66e4348SPetr Machata 
18769b7320eSPetr Machata 	return switchdev_port_obj_add(dev, &v.obj, extack);
188d66e4348SPetr Machata }
189d66e4348SPetr Machata 
br_switchdev_port_vlan_del(struct net_device * dev,u16 vid)190d66e4348SPetr Machata int br_switchdev_port_vlan_del(struct net_device *dev, u16 vid)
191d66e4348SPetr Machata {
192d66e4348SPetr Machata 	struct switchdev_obj_port_vlan v = {
193d66e4348SPetr Machata 		.obj.orig_dev = dev,
194d66e4348SPetr Machata 		.obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
195b7a9e0daSVladimir Oltean 		.vid = vid,
196d66e4348SPetr Machata 	};
197d66e4348SPetr Machata 
198d66e4348SPetr Machata 	return switchdev_port_obj_del(dev, &v.obj);
199d66e4348SPetr Machata }
20085826610STobias Waldekranz 
nbp_switchdev_hwdom_set(struct net_bridge_port * joining)20185826610STobias Waldekranz static int nbp_switchdev_hwdom_set(struct net_bridge_port *joining)
20285826610STobias Waldekranz {
20385826610STobias Waldekranz 	struct net_bridge *br = joining->br;
20485826610STobias Waldekranz 	struct net_bridge_port *p;
20585826610STobias Waldekranz 	int hwdom;
20685826610STobias Waldekranz 
20785826610STobias Waldekranz 	/* joining is yet to be added to the port list. */
20885826610STobias Waldekranz 	list_for_each_entry(p, &br->port_list, list) {
2092f5dc00fSVladimir Oltean 		if (netdev_phys_item_id_same(&joining->ppid, &p->ppid)) {
21085826610STobias Waldekranz 			joining->hwdom = p->hwdom;
21185826610STobias Waldekranz 			return 0;
21285826610STobias Waldekranz 		}
21385826610STobias Waldekranz 	}
21485826610STobias Waldekranz 
21585826610STobias Waldekranz 	hwdom = find_next_zero_bit(&br->busy_hwdoms, BR_HWDOM_MAX, 1);
21685826610STobias Waldekranz 	if (hwdom >= BR_HWDOM_MAX)
21785826610STobias Waldekranz 		return -EBUSY;
21885826610STobias Waldekranz 
21985826610STobias Waldekranz 	set_bit(hwdom, &br->busy_hwdoms);
22085826610STobias Waldekranz 	joining->hwdom = hwdom;
22185826610STobias Waldekranz 	return 0;
22285826610STobias Waldekranz }
22385826610STobias Waldekranz 
nbp_switchdev_hwdom_put(struct net_bridge_port * leaving)22485826610STobias Waldekranz static void nbp_switchdev_hwdom_put(struct net_bridge_port *leaving)
22585826610STobias Waldekranz {
22685826610STobias Waldekranz 	struct net_bridge *br = leaving->br;
22785826610STobias Waldekranz 	struct net_bridge_port *p;
22885826610STobias Waldekranz 
22985826610STobias Waldekranz 	/* leaving is no longer in the port list. */
23085826610STobias Waldekranz 	list_for_each_entry(p, &br->port_list, list) {
23185826610STobias Waldekranz 		if (p->hwdom == leaving->hwdom)
23285826610STobias Waldekranz 			return;
23385826610STobias Waldekranz 	}
23485826610STobias Waldekranz 
23585826610STobias Waldekranz 	clear_bit(leaving->hwdom, &br->busy_hwdoms);
23685826610STobias Waldekranz }
23785826610STobias Waldekranz 
nbp_switchdev_add(struct net_bridge_port * p,struct netdev_phys_item_id ppid,bool tx_fwd_offload,struct netlink_ext_ack * extack)2382f5dc00fSVladimir Oltean static int nbp_switchdev_add(struct net_bridge_port *p,
2392f5dc00fSVladimir Oltean 			     struct netdev_phys_item_id ppid,
24047211192STobias Waldekranz 			     bool tx_fwd_offload,
2412f5dc00fSVladimir Oltean 			     struct netlink_ext_ack *extack)
24285826610STobias Waldekranz {
24347211192STobias Waldekranz 	int err;
24447211192STobias Waldekranz 
2452f5dc00fSVladimir Oltean 	if (p->offload_count) {
2462f5dc00fSVladimir Oltean 		/* Prevent unsupported configurations such as a bridge port
2472f5dc00fSVladimir Oltean 		 * which is a bonding interface, and the member ports are from
2482f5dc00fSVladimir Oltean 		 * different hardware switches.
2492f5dc00fSVladimir Oltean 		 */
2502f5dc00fSVladimir Oltean 		if (!netdev_phys_item_id_same(&p->ppid, &ppid)) {
2512f5dc00fSVladimir Oltean 			NL_SET_ERR_MSG_MOD(extack,
2522f5dc00fSVladimir Oltean 					   "Same bridge port cannot be offloaded by two physical switches");
2532f5dc00fSVladimir Oltean 			return -EBUSY;
25485826610STobias Waldekranz 		}
25585826610STobias Waldekranz 
2562f5dc00fSVladimir Oltean 		/* Tolerate drivers that call switchdev_bridge_port_offload()
2572f5dc00fSVladimir Oltean 		 * more than once for the same bridge port, such as when the
2582f5dc00fSVladimir Oltean 		 * bridge port is an offloaded bonding/team interface.
2592f5dc00fSVladimir Oltean 		 */
2602f5dc00fSVladimir Oltean 		p->offload_count++;
2612f5dc00fSVladimir Oltean 
2622f5dc00fSVladimir Oltean 		return 0;
2632f5dc00fSVladimir Oltean 	}
2642f5dc00fSVladimir Oltean 
2652f5dc00fSVladimir Oltean 	p->ppid = ppid;
2662f5dc00fSVladimir Oltean 	p->offload_count = 1;
2672f5dc00fSVladimir Oltean 
26847211192STobias Waldekranz 	err = nbp_switchdev_hwdom_set(p);
26947211192STobias Waldekranz 	if (err)
27047211192STobias Waldekranz 		return err;
27147211192STobias Waldekranz 
27247211192STobias Waldekranz 	if (tx_fwd_offload) {
27347211192STobias Waldekranz 		p->flags |= BR_TX_FWD_OFFLOAD;
27447211192STobias Waldekranz 		static_branch_inc(&br_switchdev_tx_fwd_offload);
27547211192STobias Waldekranz 	}
27647211192STobias Waldekranz 
27747211192STobias Waldekranz 	return 0;
27885826610STobias Waldekranz }
27985826610STobias Waldekranz 
nbp_switchdev_del(struct net_bridge_port * p)2802f5dc00fSVladimir Oltean static void nbp_switchdev_del(struct net_bridge_port *p)
28185826610STobias Waldekranz {
2822f5dc00fSVladimir Oltean 	if (WARN_ON(!p->offload_count))
2832f5dc00fSVladimir Oltean 		return;
2842f5dc00fSVladimir Oltean 
2852f5dc00fSVladimir Oltean 	p->offload_count--;
2862f5dc00fSVladimir Oltean 
2872f5dc00fSVladimir Oltean 	if (p->offload_count)
2882f5dc00fSVladimir Oltean 		return;
28985826610STobias Waldekranz 
29085826610STobias Waldekranz 	if (p->hwdom)
29185826610STobias Waldekranz 		nbp_switchdev_hwdom_put(p);
29247211192STobias Waldekranz 
29347211192STobias Waldekranz 	if (p->flags & BR_TX_FWD_OFFLOAD) {
29447211192STobias Waldekranz 		p->flags &= ~BR_TX_FWD_OFFLOAD;
29547211192STobias Waldekranz 		static_branch_dec(&br_switchdev_tx_fwd_offload);
29647211192STobias Waldekranz 	}
29785826610STobias Waldekranz }
2982f5dc00fSVladimir Oltean 
299326b212eSVladimir Oltean static int
br_switchdev_fdb_replay_one(struct net_bridge * br,struct notifier_block * nb,const struct net_bridge_fdb_entry * fdb,unsigned long action,const void * ctx)300326b212eSVladimir Oltean br_switchdev_fdb_replay_one(struct net_bridge *br, struct notifier_block *nb,
3015cda5272SVladimir Oltean 			    const struct net_bridge_fdb_entry *fdb,
3025cda5272SVladimir Oltean 			    unsigned long action, const void *ctx)
3035cda5272SVladimir Oltean {
3045cda5272SVladimir Oltean 	struct switchdev_notifier_fdb_info item;
3055cda5272SVladimir Oltean 	int err;
3065cda5272SVladimir Oltean 
307fab9eca8SVladimir Oltean 	br_switchdev_fdb_populate(br, &item, fdb, ctx);
3085cda5272SVladimir Oltean 
3095cda5272SVladimir Oltean 	err = nb->notifier_call(nb, action, &item);
3105cda5272SVladimir Oltean 	return notifier_to_errno(err);
3115cda5272SVladimir Oltean }
3125cda5272SVladimir Oltean 
313326b212eSVladimir Oltean static int
br_switchdev_fdb_replay(const struct net_device * br_dev,const void * ctx,bool adding,struct notifier_block * nb)314326b212eSVladimir Oltean br_switchdev_fdb_replay(const struct net_device *br_dev, const void *ctx,
3155cda5272SVladimir Oltean 			bool adding, struct notifier_block *nb)
3165cda5272SVladimir Oltean {
3175cda5272SVladimir Oltean 	struct net_bridge_fdb_entry *fdb;
3185cda5272SVladimir Oltean 	struct net_bridge *br;
3195cda5272SVladimir Oltean 	unsigned long action;
3205cda5272SVladimir Oltean 	int err = 0;
3215cda5272SVladimir Oltean 
3225cda5272SVladimir Oltean 	if (!nb)
3235cda5272SVladimir Oltean 		return 0;
3245cda5272SVladimir Oltean 
3255cda5272SVladimir Oltean 	if (!netif_is_bridge_master(br_dev))
3265cda5272SVladimir Oltean 		return -EINVAL;
3275cda5272SVladimir Oltean 
3285cda5272SVladimir Oltean 	br = netdev_priv(br_dev);
3295cda5272SVladimir Oltean 
3305cda5272SVladimir Oltean 	if (adding)
3315cda5272SVladimir Oltean 		action = SWITCHDEV_FDB_ADD_TO_DEVICE;
3325cda5272SVladimir Oltean 	else
3335cda5272SVladimir Oltean 		action = SWITCHDEV_FDB_DEL_TO_DEVICE;
3345cda5272SVladimir Oltean 
3355cda5272SVladimir Oltean 	rcu_read_lock();
3365cda5272SVladimir Oltean 
3375cda5272SVladimir Oltean 	hlist_for_each_entry_rcu(fdb, &br->fdb_list, fdb_node) {
338326b212eSVladimir Oltean 		err = br_switchdev_fdb_replay_one(br, nb, fdb, action, ctx);
3395cda5272SVladimir Oltean 		if (err)
3405cda5272SVladimir Oltean 			break;
3415cda5272SVladimir Oltean 	}
3425cda5272SVladimir Oltean 
3435cda5272SVladimir Oltean 	rcu_read_unlock();
3445cda5272SVladimir Oltean 
3455cda5272SVladimir Oltean 	return err;
3465cda5272SVladimir Oltean }
3475cda5272SVladimir Oltean 
br_switchdev_vlan_attr_replay(struct net_device * br_dev,const void * ctx,struct notifier_block * nb,struct netlink_ext_ack * extack)3486284c723STobias Waldekranz static int br_switchdev_vlan_attr_replay(struct net_device *br_dev,
3496284c723STobias Waldekranz 					 const void *ctx,
3506284c723STobias Waldekranz 					 struct notifier_block *nb,
3516284c723STobias Waldekranz 					 struct netlink_ext_ack *extack)
3526284c723STobias Waldekranz {
3536284c723STobias Waldekranz 	struct switchdev_notifier_port_attr_info attr_info = {
3546284c723STobias Waldekranz 		.info = {
3556284c723STobias Waldekranz 			.dev = br_dev,
3566284c723STobias Waldekranz 			.extack = extack,
3576284c723STobias Waldekranz 			.ctx = ctx,
3586284c723STobias Waldekranz 		},
3596284c723STobias Waldekranz 	};
3606284c723STobias Waldekranz 	struct net_bridge *br = netdev_priv(br_dev);
3616284c723STobias Waldekranz 	struct net_bridge_vlan_group *vg;
3626284c723STobias Waldekranz 	struct switchdev_attr attr;
3636284c723STobias Waldekranz 	struct net_bridge_vlan *v;
3646284c723STobias Waldekranz 	int err;
3656284c723STobias Waldekranz 
3666284c723STobias Waldekranz 	attr_info.attr = &attr;
3676284c723STobias Waldekranz 	attr.orig_dev = br_dev;
3686284c723STobias Waldekranz 
3696284c723STobias Waldekranz 	vg = br_vlan_group(br);
3707f40ea21SClément Léger 	if (!vg)
3717f40ea21SClément Léger 		return 0;
3726284c723STobias Waldekranz 
3736284c723STobias Waldekranz 	list_for_each_entry(v, &vg->vlan_list, vlist) {
3746284c723STobias Waldekranz 		if (v->msti) {
3756284c723STobias Waldekranz 			attr.id = SWITCHDEV_ATTR_ID_VLAN_MSTI;
3766284c723STobias Waldekranz 			attr.u.vlan_msti.vid = v->vid;
3776284c723STobias Waldekranz 			attr.u.vlan_msti.msti = v->msti;
3786284c723STobias Waldekranz 
3796284c723STobias Waldekranz 			err = nb->notifier_call(nb, SWITCHDEV_PORT_ATTR_SET,
3806284c723STobias Waldekranz 						&attr_info);
3816284c723STobias Waldekranz 			err = notifier_to_errno(err);
3826284c723STobias Waldekranz 			if (err)
3836284c723STobias Waldekranz 				return err;
3846284c723STobias Waldekranz 		}
3856284c723STobias Waldekranz 	}
3866284c723STobias Waldekranz 
3876284c723STobias Waldekranz 	return 0;
3886284c723STobias Waldekranz }
3896284c723STobias Waldekranz 
390326b212eSVladimir Oltean static int
br_switchdev_vlan_replay_one(struct notifier_block * nb,struct net_device * dev,struct switchdev_obj_port_vlan * vlan,const void * ctx,unsigned long action,struct netlink_ext_ack * extack)391326b212eSVladimir Oltean br_switchdev_vlan_replay_one(struct notifier_block *nb,
3924a6849e4SVladimir Oltean 			     struct net_device *dev,
3934a6849e4SVladimir Oltean 			     struct switchdev_obj_port_vlan *vlan,
3944a6849e4SVladimir Oltean 			     const void *ctx, unsigned long action,
3954a6849e4SVladimir Oltean 			     struct netlink_ext_ack *extack)
3964a6849e4SVladimir Oltean {
3974a6849e4SVladimir Oltean 	struct switchdev_notifier_port_obj_info obj_info = {
3984a6849e4SVladimir Oltean 		.info = {
3994a6849e4SVladimir Oltean 			.dev = dev,
4004a6849e4SVladimir Oltean 			.extack = extack,
4014a6849e4SVladimir Oltean 			.ctx = ctx,
4024a6849e4SVladimir Oltean 		},
4034a6849e4SVladimir Oltean 		.obj = &vlan->obj,
4044a6849e4SVladimir Oltean 	};
4054a6849e4SVladimir Oltean 	int err;
4064a6849e4SVladimir Oltean 
4074a6849e4SVladimir Oltean 	err = nb->notifier_call(nb, action, &obj_info);
4084a6849e4SVladimir Oltean 	return notifier_to_errno(err);
4094a6849e4SVladimir Oltean }
4104a6849e4SVladimir Oltean 
br_switchdev_vlan_replay_group(struct notifier_block * nb,struct net_device * dev,struct net_bridge_vlan_group * vg,const void * ctx,unsigned long action,struct netlink_ext_ack * extack)411b28d580eSVladimir Oltean static int br_switchdev_vlan_replay_group(struct notifier_block *nb,
412326b212eSVladimir Oltean 					  struct net_device *dev,
413b28d580eSVladimir Oltean 					  struct net_bridge_vlan_group *vg,
414b28d580eSVladimir Oltean 					  const void *ctx, unsigned long action,
4154a6849e4SVladimir Oltean 					  struct netlink_ext_ack *extack)
4164a6849e4SVladimir Oltean {
4174a6849e4SVladimir Oltean 	struct net_bridge_vlan *v;
4184a6849e4SVladimir Oltean 	int err = 0;
4194a6849e4SVladimir Oltean 	u16 pvid;
4204a6849e4SVladimir Oltean 
4214a6849e4SVladimir Oltean 	if (!vg)
4224a6849e4SVladimir Oltean 		return 0;
4234a6849e4SVladimir Oltean 
4244a6849e4SVladimir Oltean 	pvid = br_get_pvid(vg);
4254a6849e4SVladimir Oltean 
4264a6849e4SVladimir Oltean 	list_for_each_entry(v, &vg->vlan_list, vlist) {
4274a6849e4SVladimir Oltean 		struct switchdev_obj_port_vlan vlan = {
4284a6849e4SVladimir Oltean 			.obj.orig_dev = dev,
4294a6849e4SVladimir Oltean 			.obj.id = SWITCHDEV_OBJ_ID_PORT_VLAN,
4304a6849e4SVladimir Oltean 			.flags = br_vlan_flags(v, pvid),
4314a6849e4SVladimir Oltean 			.vid = v->vid,
4324a6849e4SVladimir Oltean 		};
4334a6849e4SVladimir Oltean 
4344a6849e4SVladimir Oltean 		if (!br_vlan_should_use(v))
4354a6849e4SVladimir Oltean 			continue;
4364a6849e4SVladimir Oltean 
437326b212eSVladimir Oltean 		err = br_switchdev_vlan_replay_one(nb, dev, &vlan, ctx,
438326b212eSVladimir Oltean 						   action, extack);
4394a6849e4SVladimir Oltean 		if (err)
4404a6849e4SVladimir Oltean 			return err;
4414a6849e4SVladimir Oltean 	}
4424a6849e4SVladimir Oltean 
443b28d580eSVladimir Oltean 	return 0;
444b28d580eSVladimir Oltean }
445b28d580eSVladimir Oltean 
br_switchdev_vlan_replay(struct net_device * br_dev,const void * ctx,bool adding,struct notifier_block * nb,struct netlink_ext_ack * extack)446b28d580eSVladimir Oltean static int br_switchdev_vlan_replay(struct net_device *br_dev,
447b28d580eSVladimir Oltean 				    const void *ctx, bool adding,
448b28d580eSVladimir Oltean 				    struct notifier_block *nb,
449b28d580eSVladimir Oltean 				    struct netlink_ext_ack *extack)
450b28d580eSVladimir Oltean {
451b28d580eSVladimir Oltean 	struct net_bridge *br = netdev_priv(br_dev);
452b28d580eSVladimir Oltean 	struct net_bridge_port *p;
453b28d580eSVladimir Oltean 	unsigned long action;
454b28d580eSVladimir Oltean 	int err;
455b28d580eSVladimir Oltean 
456b28d580eSVladimir Oltean 	ASSERT_RTNL();
457b28d580eSVladimir Oltean 
458b28d580eSVladimir Oltean 	if (!nb)
459b28d580eSVladimir Oltean 		return 0;
460b28d580eSVladimir Oltean 
461b28d580eSVladimir Oltean 	if (!netif_is_bridge_master(br_dev))
462b28d580eSVladimir Oltean 		return -EINVAL;
463b28d580eSVladimir Oltean 
464b28d580eSVladimir Oltean 	if (adding)
465b28d580eSVladimir Oltean 		action = SWITCHDEV_PORT_OBJ_ADD;
466b28d580eSVladimir Oltean 	else
467b28d580eSVladimir Oltean 		action = SWITCHDEV_PORT_OBJ_DEL;
468b28d580eSVladimir Oltean 
469b28d580eSVladimir Oltean 	err = br_switchdev_vlan_replay_group(nb, br_dev, br_vlan_group(br),
470b28d580eSVladimir Oltean 					     ctx, action, extack);
471b28d580eSVladimir Oltean 	if (err)
4724a6849e4SVladimir Oltean 		return err;
473b28d580eSVladimir Oltean 
474b28d580eSVladimir Oltean 	list_for_each_entry(p, &br->port_list, list) {
475b28d580eSVladimir Oltean 		struct net_device *dev = p->dev;
476b28d580eSVladimir Oltean 
477b28d580eSVladimir Oltean 		err = br_switchdev_vlan_replay_group(nb, dev,
478b28d580eSVladimir Oltean 						     nbp_vlan_group(p),
479b28d580eSVladimir Oltean 						     ctx, action, extack);
480b28d580eSVladimir Oltean 		if (err)
481b28d580eSVladimir Oltean 			return err;
482b28d580eSVladimir Oltean 	}
483b28d580eSVladimir Oltean 
4846284c723STobias Waldekranz 	if (adding) {
4856284c723STobias Waldekranz 		err = br_switchdev_vlan_attr_replay(br_dev, ctx, nb, extack);
4866284c723STobias Waldekranz 		if (err)
4876284c723STobias Waldekranz 			return err;
4886284c723STobias Waldekranz 	}
4896284c723STobias Waldekranz 
490b28d580eSVladimir Oltean 	return 0;
4914a6849e4SVladimir Oltean }
4924a6849e4SVladimir Oltean 
4939776457cSVladimir Oltean #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
494326b212eSVladimir Oltean struct br_switchdev_mdb_complete_info {
4959776457cSVladimir Oltean 	struct net_bridge_port *port;
4969776457cSVladimir Oltean 	struct br_ip ip;
4979776457cSVladimir Oltean };
4989776457cSVladimir Oltean 
br_switchdev_mdb_complete(struct net_device * dev,int err,void * priv)499326b212eSVladimir Oltean static void br_switchdev_mdb_complete(struct net_device *dev, int err, void *priv)
5009776457cSVladimir Oltean {
501326b212eSVladimir Oltean 	struct br_switchdev_mdb_complete_info *data = priv;
5029776457cSVladimir Oltean 	struct net_bridge_port_group __rcu **pp;
5039776457cSVladimir Oltean 	struct net_bridge_port_group *p;
5049776457cSVladimir Oltean 	struct net_bridge_mdb_entry *mp;
5059776457cSVladimir Oltean 	struct net_bridge_port *port = data->port;
5069776457cSVladimir Oltean 	struct net_bridge *br = port->br;
5079776457cSVladimir Oltean 
5089776457cSVladimir Oltean 	if (err)
5099776457cSVladimir Oltean 		goto err;
5109776457cSVladimir Oltean 
5119776457cSVladimir Oltean 	spin_lock_bh(&br->multicast_lock);
5129776457cSVladimir Oltean 	mp = br_mdb_ip_get(br, &data->ip);
5139776457cSVladimir Oltean 	if (!mp)
5149776457cSVladimir Oltean 		goto out;
5159776457cSVladimir Oltean 	for (pp = &mp->ports; (p = mlock_dereference(*pp, br)) != NULL;
5169776457cSVladimir Oltean 	     pp = &p->next) {
5179776457cSVladimir Oltean 		if (p->key.port != port)
5189776457cSVladimir Oltean 			continue;
5199776457cSVladimir Oltean 		p->flags |= MDB_PG_FLAGS_OFFLOAD;
5209776457cSVladimir Oltean 	}
5219776457cSVladimir Oltean out:
5229776457cSVladimir Oltean 	spin_unlock_bh(&br->multicast_lock);
5239776457cSVladimir Oltean err:
5249776457cSVladimir Oltean 	kfree(priv);
5259776457cSVladimir Oltean }
5269776457cSVladimir Oltean 
br_switchdev_mdb_populate(struct switchdev_obj_port_mdb * mdb,const struct net_bridge_mdb_entry * mp)5279776457cSVladimir Oltean static void br_switchdev_mdb_populate(struct switchdev_obj_port_mdb *mdb,
5289776457cSVladimir Oltean 				      const struct net_bridge_mdb_entry *mp)
5299776457cSVladimir Oltean {
5309776457cSVladimir Oltean 	if (mp->addr.proto == htons(ETH_P_IP))
5319776457cSVladimir Oltean 		ip_eth_mc_map(mp->addr.dst.ip4, mdb->addr);
5329776457cSVladimir Oltean #if IS_ENABLED(CONFIG_IPV6)
5339776457cSVladimir Oltean 	else if (mp->addr.proto == htons(ETH_P_IPV6))
5349776457cSVladimir Oltean 		ipv6_eth_mc_map(&mp->addr.dst.ip6, mdb->addr);
5359776457cSVladimir Oltean #endif
5369776457cSVladimir Oltean 	else
5379776457cSVladimir Oltean 		ether_addr_copy(mdb->addr, mp->addr.dst.mac_addr);
5389776457cSVladimir Oltean 
5399776457cSVladimir Oltean 	mdb->vid = mp->addr.vid;
5409776457cSVladimir Oltean }
5419776457cSVladimir Oltean 
br_switchdev_host_mdb_one(struct net_device * dev,struct net_device * lower_dev,struct net_bridge_mdb_entry * mp,int type)542326b212eSVladimir Oltean static void br_switchdev_host_mdb_one(struct net_device *dev,
5439776457cSVladimir Oltean 				      struct net_device *lower_dev,
5449776457cSVladimir Oltean 				      struct net_bridge_mdb_entry *mp,
5459776457cSVladimir Oltean 				      int type)
5469776457cSVladimir Oltean {
5479776457cSVladimir Oltean 	struct switchdev_obj_port_mdb mdb = {
5489776457cSVladimir Oltean 		.obj = {
5499776457cSVladimir Oltean 			.id = SWITCHDEV_OBJ_ID_HOST_MDB,
5509776457cSVladimir Oltean 			.flags = SWITCHDEV_F_DEFER,
5519776457cSVladimir Oltean 			.orig_dev = dev,
5529776457cSVladimir Oltean 		},
5539776457cSVladimir Oltean 	};
5549776457cSVladimir Oltean 
5559776457cSVladimir Oltean 	br_switchdev_mdb_populate(&mdb, mp);
5569776457cSVladimir Oltean 
5579776457cSVladimir Oltean 	switch (type) {
5589776457cSVladimir Oltean 	case RTM_NEWMDB:
5599776457cSVladimir Oltean 		switchdev_port_obj_add(lower_dev, &mdb.obj, NULL);
5609776457cSVladimir Oltean 		break;
5619776457cSVladimir Oltean 	case RTM_DELMDB:
5629776457cSVladimir Oltean 		switchdev_port_obj_del(lower_dev, &mdb.obj);
5639776457cSVladimir Oltean 		break;
5649776457cSVladimir Oltean 	}
5659776457cSVladimir Oltean }
5669776457cSVladimir Oltean 
br_switchdev_host_mdb(struct net_device * dev,struct net_bridge_mdb_entry * mp,int type)567326b212eSVladimir Oltean static void br_switchdev_host_mdb(struct net_device *dev,
5689776457cSVladimir Oltean 				  struct net_bridge_mdb_entry *mp, int type)
5699776457cSVladimir Oltean {
5709776457cSVladimir Oltean 	struct net_device *lower_dev;
5719776457cSVladimir Oltean 	struct list_head *iter;
5729776457cSVladimir Oltean 
5739776457cSVladimir Oltean 	netdev_for_each_lower_dev(dev, lower_dev, iter)
574326b212eSVladimir Oltean 		br_switchdev_host_mdb_one(dev, lower_dev, mp, type);
5759776457cSVladimir Oltean }
5769776457cSVladimir Oltean 
577326b212eSVladimir Oltean static int
br_switchdev_mdb_replay_one(struct notifier_block * nb,struct net_device * dev,const struct switchdev_obj_port_mdb * mdb,unsigned long action,const void * ctx,struct netlink_ext_ack * extack)578326b212eSVladimir Oltean br_switchdev_mdb_replay_one(struct notifier_block *nb, struct net_device *dev,
5799776457cSVladimir Oltean 			    const struct switchdev_obj_port_mdb *mdb,
5809776457cSVladimir Oltean 			    unsigned long action, const void *ctx,
5819776457cSVladimir Oltean 			    struct netlink_ext_ack *extack)
5829776457cSVladimir Oltean {
5839776457cSVladimir Oltean 	struct switchdev_notifier_port_obj_info obj_info = {
5849776457cSVladimir Oltean 		.info = {
5859776457cSVladimir Oltean 			.dev = dev,
5869776457cSVladimir Oltean 			.extack = extack,
5879776457cSVladimir Oltean 			.ctx = ctx,
5889776457cSVladimir Oltean 		},
5899776457cSVladimir Oltean 		.obj = &mdb->obj,
5909776457cSVladimir Oltean 	};
5919776457cSVladimir Oltean 	int err;
5929776457cSVladimir Oltean 
5939776457cSVladimir Oltean 	err = nb->notifier_call(nb, action, &obj_info);
5949776457cSVladimir Oltean 	return notifier_to_errno(err);
5959776457cSVladimir Oltean }
5969776457cSVladimir Oltean 
br_switchdev_mdb_queue_one(struct list_head * mdb_list,struct net_device * dev,unsigned long action,enum switchdev_obj_id id,const struct net_bridge_mdb_entry * mp,struct net_device * orig_dev)597326b212eSVladimir Oltean static int br_switchdev_mdb_queue_one(struct list_head *mdb_list,
598603be954STobias Waldekranz 				      struct net_device *dev,
599603be954STobias Waldekranz 				      unsigned long action,
6009776457cSVladimir Oltean 				      enum switchdev_obj_id id,
6019776457cSVladimir Oltean 				      const struct net_bridge_mdb_entry *mp,
6029776457cSVladimir Oltean 				      struct net_device *orig_dev)
6039776457cSVladimir Oltean {
604603be954STobias Waldekranz 	struct switchdev_obj_port_mdb mdb = {
605603be954STobias Waldekranz 		.obj = {
606603be954STobias Waldekranz 			.id = id,
607603be954STobias Waldekranz 			.orig_dev = orig_dev,
608603be954STobias Waldekranz 		},
609603be954STobias Waldekranz 	};
610603be954STobias Waldekranz 	struct switchdev_obj_port_mdb *pmdb;
6119776457cSVladimir Oltean 
612603be954STobias Waldekranz 	br_switchdev_mdb_populate(&mdb, mp);
613603be954STobias Waldekranz 
614603be954STobias Waldekranz 	if (action == SWITCHDEV_PORT_OBJ_ADD &&
615603be954STobias Waldekranz 	    switchdev_port_obj_act_is_deferred(dev, action, &mdb.obj)) {
616603be954STobias Waldekranz 		/* This event is already in the deferred queue of
617603be954STobias Waldekranz 		 * events, so this replay must be elided, lest the
618603be954STobias Waldekranz 		 * driver receives duplicate events for it. This can
619603be954STobias Waldekranz 		 * only happen when replaying additions, since
620603be954STobias Waldekranz 		 * modifications are always immediately visible in
621603be954STobias Waldekranz 		 * br->mdb_list, whereas actual event delivery may be
622603be954STobias Waldekranz 		 * delayed.
623603be954STobias Waldekranz 		 */
624603be954STobias Waldekranz 		return 0;
625603be954STobias Waldekranz 	}
626603be954STobias Waldekranz 
627603be954STobias Waldekranz 	pmdb = kmemdup(&mdb, sizeof(mdb), GFP_ATOMIC);
628603be954STobias Waldekranz 	if (!pmdb)
6299776457cSVladimir Oltean 		return -ENOMEM;
6309776457cSVladimir Oltean 
631603be954STobias Waldekranz 	list_add_tail(&pmdb->obj.list, mdb_list);
6329776457cSVladimir Oltean 	return 0;
6339776457cSVladimir Oltean }
6349776457cSVladimir Oltean 
br_switchdev_mdb_notify(struct net_device * dev,struct net_bridge_mdb_entry * mp,struct net_bridge_port_group * pg,int type)6359776457cSVladimir Oltean void br_switchdev_mdb_notify(struct net_device *dev,
6369776457cSVladimir Oltean 			     struct net_bridge_mdb_entry *mp,
6379776457cSVladimir Oltean 			     struct net_bridge_port_group *pg,
6389776457cSVladimir Oltean 			     int type)
6399776457cSVladimir Oltean {
640326b212eSVladimir Oltean 	struct br_switchdev_mdb_complete_info *complete_info;
6419776457cSVladimir Oltean 	struct switchdev_obj_port_mdb mdb = {
6429776457cSVladimir Oltean 		.obj = {
6439776457cSVladimir Oltean 			.id = SWITCHDEV_OBJ_ID_PORT_MDB,
6449776457cSVladimir Oltean 			.flags = SWITCHDEV_F_DEFER,
6459776457cSVladimir Oltean 		},
6469776457cSVladimir Oltean 	};
6479776457cSVladimir Oltean 
6489776457cSVladimir Oltean 	if (!pg)
649326b212eSVladimir Oltean 		return br_switchdev_host_mdb(dev, mp, type);
6509776457cSVladimir Oltean 
6519776457cSVladimir Oltean 	br_switchdev_mdb_populate(&mdb, mp);
6529776457cSVladimir Oltean 
6539776457cSVladimir Oltean 	mdb.obj.orig_dev = pg->key.port->dev;
6549776457cSVladimir Oltean 	switch (type) {
6559776457cSVladimir Oltean 	case RTM_NEWMDB:
6569776457cSVladimir Oltean 		complete_info = kmalloc(sizeof(*complete_info), GFP_ATOMIC);
6579776457cSVladimir Oltean 		if (!complete_info)
6589776457cSVladimir Oltean 			break;
6599776457cSVladimir Oltean 		complete_info->port = pg->key.port;
6609776457cSVladimir Oltean 		complete_info->ip = mp->addr;
6619776457cSVladimir Oltean 		mdb.obj.complete_priv = complete_info;
662326b212eSVladimir Oltean 		mdb.obj.complete = br_switchdev_mdb_complete;
6639776457cSVladimir Oltean 		if (switchdev_port_obj_add(pg->key.port->dev, &mdb.obj, NULL))
6649776457cSVladimir Oltean 			kfree(complete_info);
6659776457cSVladimir Oltean 		break;
6669776457cSVladimir Oltean 	case RTM_DELMDB:
6679776457cSVladimir Oltean 		switchdev_port_obj_del(pg->key.port->dev, &mdb.obj);
6689776457cSVladimir Oltean 		break;
6699776457cSVladimir Oltean 	}
6709776457cSVladimir Oltean }
6719776457cSVladimir Oltean #endif
6729776457cSVladimir Oltean 
673326b212eSVladimir Oltean static int
br_switchdev_mdb_replay(struct net_device * br_dev,struct net_device * dev,const void * ctx,bool adding,struct notifier_block * nb,struct netlink_ext_ack * extack)674326b212eSVladimir Oltean br_switchdev_mdb_replay(struct net_device *br_dev, struct net_device *dev,
675326b212eSVladimir Oltean 			const void *ctx, bool adding, struct notifier_block *nb,
6769776457cSVladimir Oltean 			struct netlink_ext_ack *extack)
6779776457cSVladimir Oltean {
6789776457cSVladimir Oltean #ifdef CONFIG_BRIDGE_IGMP_SNOOPING
6799776457cSVladimir Oltean 	const struct net_bridge_mdb_entry *mp;
6809776457cSVladimir Oltean 	struct switchdev_obj *obj, *tmp;
6819776457cSVladimir Oltean 	struct net_bridge *br;
6829776457cSVladimir Oltean 	unsigned long action;
6839776457cSVladimir Oltean 	LIST_HEAD(mdb_list);
6849776457cSVladimir Oltean 	int err = 0;
6859776457cSVladimir Oltean 
6869776457cSVladimir Oltean 	ASSERT_RTNL();
6879776457cSVladimir Oltean 
6889776457cSVladimir Oltean 	if (!nb)
6899776457cSVladimir Oltean 		return 0;
6909776457cSVladimir Oltean 
6919776457cSVladimir Oltean 	if (!netif_is_bridge_master(br_dev) || !netif_is_bridge_port(dev))
6929776457cSVladimir Oltean 		return -EINVAL;
6939776457cSVladimir Oltean 
6949776457cSVladimir Oltean 	br = netdev_priv(br_dev);
6959776457cSVladimir Oltean 
6969776457cSVladimir Oltean 	if (!br_opt_get(br, BROPT_MULTICAST_ENABLED))
6979776457cSVladimir Oltean 		return 0;
6989776457cSVladimir Oltean 
6999776457cSVladimir Oltean 	if (adding)
7009776457cSVladimir Oltean 		action = SWITCHDEV_PORT_OBJ_ADD;
7019776457cSVladimir Oltean 	else
7029776457cSVladimir Oltean 		action = SWITCHDEV_PORT_OBJ_DEL;
7039776457cSVladimir Oltean 
704603be954STobias Waldekranz 	/* br_switchdev_mdb_queue_one() will take care to not queue a
705603be954STobias Waldekranz 	 * replay of an event that is already pending in the switchdev
706603be954STobias Waldekranz 	 * deferred queue. In order to safely determine that, there
707603be954STobias Waldekranz 	 * must be no new deferred MDB notifications enqueued for the
708603be954STobias Waldekranz 	 * duration of the MDB scan. Therefore, grab the write-side
709603be954STobias Waldekranz 	 * lock to avoid racing with any concurrent IGMP/MLD snooping.
710603be954STobias Waldekranz 	 */
711603be954STobias Waldekranz 	spin_lock_bh(&br->multicast_lock);
712603be954STobias Waldekranz 
713603be954STobias Waldekranz 	hlist_for_each_entry(mp, &br->mdb_list, mdb_node) {
714603be954STobias Waldekranz 		struct net_bridge_port_group __rcu * const *pp;
715603be954STobias Waldekranz 		const struct net_bridge_port_group *p;
716603be954STobias Waldekranz 
717603be954STobias Waldekranz 		if (mp->host_joined) {
718603be954STobias Waldekranz 			err = br_switchdev_mdb_queue_one(&mdb_list, dev, action,
719603be954STobias Waldekranz 							 SWITCHDEV_OBJ_ID_HOST_MDB,
720603be954STobias Waldekranz 							 mp, br_dev);
721603be954STobias Waldekranz 			if (err) {
722603be954STobias Waldekranz 				spin_unlock_bh(&br->multicast_lock);
723603be954STobias Waldekranz 				goto out_free_mdb;
724603be954STobias Waldekranz 			}
725603be954STobias Waldekranz 		}
726603be954STobias Waldekranz 
727603be954STobias Waldekranz 		for (pp = &mp->ports; (p = mlock_dereference(*pp, br)) != NULL;
728603be954STobias Waldekranz 		     pp = &p->next) {
729603be954STobias Waldekranz 			if (p->key.port->dev != dev)
730603be954STobias Waldekranz 				continue;
731603be954STobias Waldekranz 
732603be954STobias Waldekranz 			err = br_switchdev_mdb_queue_one(&mdb_list, dev, action,
733603be954STobias Waldekranz 							 SWITCHDEV_OBJ_ID_PORT_MDB,
734603be954STobias Waldekranz 							 mp, dev);
735603be954STobias Waldekranz 			if (err) {
736603be954STobias Waldekranz 				spin_unlock_bh(&br->multicast_lock);
737603be954STobias Waldekranz 				goto out_free_mdb;
738603be954STobias Waldekranz 			}
739603be954STobias Waldekranz 		}
740603be954STobias Waldekranz 	}
741603be954STobias Waldekranz 
742603be954STobias Waldekranz 	spin_unlock_bh(&br->multicast_lock);
743603be954STobias Waldekranz 
7449776457cSVladimir Oltean 	list_for_each_entry(obj, &mdb_list, list) {
745326b212eSVladimir Oltean 		err = br_switchdev_mdb_replay_one(nb, dev,
746326b212eSVladimir Oltean 						  SWITCHDEV_OBJ_PORT_MDB(obj),
7479776457cSVladimir Oltean 						  action, ctx, extack);
748989280d6SPetr Machata 		if (err == -EOPNOTSUPP)
749989280d6SPetr Machata 			err = 0;
7509776457cSVladimir Oltean 		if (err)
7519776457cSVladimir Oltean 			goto out_free_mdb;
7529776457cSVladimir Oltean 	}
7539776457cSVladimir Oltean 
7549776457cSVladimir Oltean out_free_mdb:
7559776457cSVladimir Oltean 	list_for_each_entry_safe(obj, tmp, &mdb_list, list) {
7569776457cSVladimir Oltean 		list_del(&obj->list);
7579776457cSVladimir Oltean 		kfree(SWITCHDEV_OBJ_PORT_MDB(obj));
7589776457cSVladimir Oltean 	}
7599776457cSVladimir Oltean 
7609776457cSVladimir Oltean 	if (err)
7619776457cSVladimir Oltean 		return err;
7629776457cSVladimir Oltean #endif
7639776457cSVladimir Oltean 
7649776457cSVladimir Oltean 	return 0;
7659776457cSVladimir Oltean }
7669776457cSVladimir Oltean 
nbp_switchdev_sync_objs(struct net_bridge_port * p,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb,struct netlink_ext_ack * extack)7674e51bf44SVladimir Oltean static int nbp_switchdev_sync_objs(struct net_bridge_port *p, const void *ctx,
7684e51bf44SVladimir Oltean 				   struct notifier_block *atomic_nb,
7694e51bf44SVladimir Oltean 				   struct notifier_block *blocking_nb,
7704e51bf44SVladimir Oltean 				   struct netlink_ext_ack *extack)
7714e51bf44SVladimir Oltean {
7724e51bf44SVladimir Oltean 	struct net_device *br_dev = p->br->dev;
7734e51bf44SVladimir Oltean 	struct net_device *dev = p->dev;
7744e51bf44SVladimir Oltean 	int err;
7754e51bf44SVladimir Oltean 
776b28d580eSVladimir Oltean 	err = br_switchdev_vlan_replay(br_dev, ctx, true, blocking_nb, extack);
7774e51bf44SVladimir Oltean 	if (err && err != -EOPNOTSUPP)
7784e51bf44SVladimir Oltean 		return err;
7794e51bf44SVladimir Oltean 
780326b212eSVladimir Oltean 	err = br_switchdev_mdb_replay(br_dev, dev, ctx, true, blocking_nb,
781326b212eSVladimir Oltean 				      extack);
782989280d6SPetr Machata 	if (err) {
783989280d6SPetr Machata 		/* -EOPNOTSUPP not propagated from MDB replay. */
7844e51bf44SVladimir Oltean 		return err;
785989280d6SPetr Machata 	}
7864e51bf44SVladimir Oltean 
787326b212eSVladimir Oltean 	err = br_switchdev_fdb_replay(br_dev, ctx, true, atomic_nb);
7884e51bf44SVladimir Oltean 	if (err && err != -EOPNOTSUPP)
7894e51bf44SVladimir Oltean 		return err;
7904e51bf44SVladimir Oltean 
7914e51bf44SVladimir Oltean 	return 0;
7924e51bf44SVladimir Oltean }
7934e51bf44SVladimir Oltean 
nbp_switchdev_unsync_objs(struct net_bridge_port * p,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb)7944e51bf44SVladimir Oltean static void nbp_switchdev_unsync_objs(struct net_bridge_port *p,
7954e51bf44SVladimir Oltean 				      const void *ctx,
7964e51bf44SVladimir Oltean 				      struct notifier_block *atomic_nb,
7974e51bf44SVladimir Oltean 				      struct notifier_block *blocking_nb)
7984e51bf44SVladimir Oltean {
7994e51bf44SVladimir Oltean 	struct net_device *br_dev = p->br->dev;
8004e51bf44SVladimir Oltean 	struct net_device *dev = p->dev;
8014e51bf44SVladimir Oltean 
802263029aeSVladimir Oltean 	br_switchdev_fdb_replay(br_dev, ctx, false, atomic_nb);
8034e51bf44SVladimir Oltean 
804326b212eSVladimir Oltean 	br_switchdev_mdb_replay(br_dev, dev, ctx, false, blocking_nb, NULL);
8054e51bf44SVladimir Oltean 
806b28d580eSVladimir Oltean 	br_switchdev_vlan_replay(br_dev, ctx, false, blocking_nb, NULL);
807*a83856bdSTobias Waldekranz 
808*a83856bdSTobias Waldekranz 	/* Make sure that the device leaving this bridge has seen all
809*a83856bdSTobias Waldekranz 	 * relevant events before it is disassociated. In the normal
810*a83856bdSTobias Waldekranz 	 * case, when the device is directly attached to the bridge,
811*a83856bdSTobias Waldekranz 	 * this is covered by del_nbp(). If the association was indirect
812*a83856bdSTobias Waldekranz 	 * however, e.g. via a team or bond, and the device is leaving
813*a83856bdSTobias Waldekranz 	 * that intermediate device, then the bridge port remains in
814*a83856bdSTobias Waldekranz 	 * place.
815*a83856bdSTobias Waldekranz 	 */
816*a83856bdSTobias Waldekranz 	switchdev_deferred_process();
8174e51bf44SVladimir Oltean }
8184e51bf44SVladimir Oltean 
8192f5dc00fSVladimir Oltean /* Let the bridge know that this port is offloaded, so that it can assign a
8202f5dc00fSVladimir Oltean  * switchdev hardware domain to it.
8212f5dc00fSVladimir Oltean  */
br_switchdev_port_offload(struct net_bridge_port * p,struct net_device * dev,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb,bool tx_fwd_offload,struct netlink_ext_ack * extack)822957e2235SVladimir Oltean int br_switchdev_port_offload(struct net_bridge_port *p,
8234e51bf44SVladimir Oltean 			      struct net_device *dev, const void *ctx,
8244e51bf44SVladimir Oltean 			      struct notifier_block *atomic_nb,
8254e51bf44SVladimir Oltean 			      struct notifier_block *blocking_nb,
82647211192STobias Waldekranz 			      bool tx_fwd_offload,
8272f5dc00fSVladimir Oltean 			      struct netlink_ext_ack *extack)
8282f5dc00fSVladimir Oltean {
8292f5dc00fSVladimir Oltean 	struct netdev_phys_item_id ppid;
8302f5dc00fSVladimir Oltean 	int err;
8312f5dc00fSVladimir Oltean 
8322f5dc00fSVladimir Oltean 	err = dev_get_port_parent_id(dev, &ppid, false);
8332f5dc00fSVladimir Oltean 	if (err)
8342f5dc00fSVladimir Oltean 		return err;
8352f5dc00fSVladimir Oltean 
83647211192STobias Waldekranz 	err = nbp_switchdev_add(p, ppid, tx_fwd_offload, extack);
8374e51bf44SVladimir Oltean 	if (err)
8384e51bf44SVladimir Oltean 		return err;
8394e51bf44SVladimir Oltean 
8404e51bf44SVladimir Oltean 	err = nbp_switchdev_sync_objs(p, ctx, atomic_nb, blocking_nb, extack);
8414e51bf44SVladimir Oltean 	if (err)
8424e51bf44SVladimir Oltean 		goto out_switchdev_del;
8434e51bf44SVladimir Oltean 
8444e51bf44SVladimir Oltean 	return 0;
8454e51bf44SVladimir Oltean 
8464e51bf44SVladimir Oltean out_switchdev_del:
8474e51bf44SVladimir Oltean 	nbp_switchdev_del(p);
8484e51bf44SVladimir Oltean 
8494e51bf44SVladimir Oltean 	return err;
8502f5dc00fSVladimir Oltean }
8512f5dc00fSVladimir Oltean 
br_switchdev_port_unoffload(struct net_bridge_port * p,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb)852957e2235SVladimir Oltean void br_switchdev_port_unoffload(struct net_bridge_port *p, const void *ctx,
8534e51bf44SVladimir Oltean 				 struct notifier_block *atomic_nb,
8544e51bf44SVladimir Oltean 				 struct notifier_block *blocking_nb)
8552f5dc00fSVladimir Oltean {
8564e51bf44SVladimir Oltean 	nbp_switchdev_unsync_objs(p, ctx, atomic_nb, blocking_nb);
8574e51bf44SVladimir Oltean 
8582f5dc00fSVladimir Oltean 	nbp_switchdev_del(p);
8592f5dc00fSVladimir Oltean }
860f2e2857bSPetr Machata 
br_switchdev_port_replay(struct net_bridge_port * p,struct net_device * dev,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb,struct netlink_ext_ack * extack)861f2e2857bSPetr Machata int br_switchdev_port_replay(struct net_bridge_port *p,
862f2e2857bSPetr Machata 			     struct net_device *dev, const void *ctx,
863f2e2857bSPetr Machata 			     struct notifier_block *atomic_nb,
864f2e2857bSPetr Machata 			     struct notifier_block *blocking_nb,
865f2e2857bSPetr Machata 			     struct netlink_ext_ack *extack)
866f2e2857bSPetr Machata {
867f2e2857bSPetr Machata 	return nbp_switchdev_sync_objs(p, ctx, atomic_nb, blocking_nb, extack);
868f2e2857bSPetr Machata }
869