xref: /linux-6.15/net/switchdev/switchdev.c (revision ec638740)
12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2007f790cSJiri Pirko /*
3007f790cSJiri Pirko  * net/switchdev/switchdev.c - Switch device API
47ea6eb3fSJiri Pirko  * Copyright (c) 2014-2015 Jiri Pirko <[email protected]>
5f8f21471SScott Feldman  * Copyright (c) 2014-2015 Scott Feldman <[email protected]>
6007f790cSJiri Pirko  */
7007f790cSJiri Pirko 
8007f790cSJiri Pirko #include <linux/kernel.h>
9007f790cSJiri Pirko #include <linux/types.h>
10007f790cSJiri Pirko #include <linux/init.h>
1103bf0c28SJiri Pirko #include <linux/mutex.h>
1203bf0c28SJiri Pirko #include <linux/notifier.h>
13007f790cSJiri Pirko #include <linux/netdevice.h>
14850d0cbcSJiri Pirko #include <linux/etherdevice.h>
1547f8328bSScott Feldman #include <linux/if_bridge.h>
167ea6eb3fSJiri Pirko #include <linux/list.h>
17793f4014SJiri Pirko #include <linux/workqueue.h>
1887aaf2caSNikolay Aleksandrov #include <linux/if_vlan.h>
194f2c6ae5SIdo Schimmel #include <linux/rtnetlink.h>
20007f790cSJiri Pirko #include <net/switchdev.h>
21007f790cSJiri Pirko 
22793f4014SJiri Pirko static LIST_HEAD(deferred);
23793f4014SJiri Pirko static DEFINE_SPINLOCK(deferred_lock);
24793f4014SJiri Pirko 
25793f4014SJiri Pirko typedef void switchdev_deferred_func_t(struct net_device *dev,
26793f4014SJiri Pirko 				       const void *data);
27793f4014SJiri Pirko 
28793f4014SJiri Pirko struct switchdev_deferred_item {
29793f4014SJiri Pirko 	struct list_head list;
30793f4014SJiri Pirko 	struct net_device *dev;
314fc003feSEric Dumazet 	netdevice_tracker dev_tracker;
32793f4014SJiri Pirko 	switchdev_deferred_func_t *func;
33fbfc8502SGustavo A. R. Silva 	unsigned long data[];
34793f4014SJiri Pirko };
35793f4014SJiri Pirko 
36793f4014SJiri Pirko static struct switchdev_deferred_item *switchdev_deferred_dequeue(void)
37793f4014SJiri Pirko {
38793f4014SJiri Pirko 	struct switchdev_deferred_item *dfitem;
39793f4014SJiri Pirko 
40793f4014SJiri Pirko 	spin_lock_bh(&deferred_lock);
41793f4014SJiri Pirko 	if (list_empty(&deferred)) {
42793f4014SJiri Pirko 		dfitem = NULL;
43793f4014SJiri Pirko 		goto unlock;
44793f4014SJiri Pirko 	}
45793f4014SJiri Pirko 	dfitem = list_first_entry(&deferred,
46793f4014SJiri Pirko 				  struct switchdev_deferred_item, list);
47793f4014SJiri Pirko 	list_del(&dfitem->list);
48793f4014SJiri Pirko unlock:
49793f4014SJiri Pirko 	spin_unlock_bh(&deferred_lock);
50793f4014SJiri Pirko 	return dfitem;
51793f4014SJiri Pirko }
52793f4014SJiri Pirko 
53793f4014SJiri Pirko /**
54793f4014SJiri Pirko  *	switchdev_deferred_process - Process ops in deferred queue
55793f4014SJiri Pirko  *
56793f4014SJiri Pirko  *	Called to flush the ops currently queued in deferred ops queue.
57793f4014SJiri Pirko  *	rtnl_lock must be held.
58793f4014SJiri Pirko  */
59793f4014SJiri Pirko void switchdev_deferred_process(void)
60793f4014SJiri Pirko {
61793f4014SJiri Pirko 	struct switchdev_deferred_item *dfitem;
62793f4014SJiri Pirko 
63793f4014SJiri Pirko 	ASSERT_RTNL();
64793f4014SJiri Pirko 
65793f4014SJiri Pirko 	while ((dfitem = switchdev_deferred_dequeue())) {
66793f4014SJiri Pirko 		dfitem->func(dfitem->dev, dfitem->data);
674fc003feSEric Dumazet 		dev_put_track(dfitem->dev, &dfitem->dev_tracker);
68793f4014SJiri Pirko 		kfree(dfitem);
69793f4014SJiri Pirko 	}
70793f4014SJiri Pirko }
71793f4014SJiri Pirko EXPORT_SYMBOL_GPL(switchdev_deferred_process);
72793f4014SJiri Pirko 
73793f4014SJiri Pirko static void switchdev_deferred_process_work(struct work_struct *work)
74793f4014SJiri Pirko {
75793f4014SJiri Pirko 	rtnl_lock();
76793f4014SJiri Pirko 	switchdev_deferred_process();
77793f4014SJiri Pirko 	rtnl_unlock();
78793f4014SJiri Pirko }
79793f4014SJiri Pirko 
80793f4014SJiri Pirko static DECLARE_WORK(deferred_process_work, switchdev_deferred_process_work);
81793f4014SJiri Pirko 
82793f4014SJiri Pirko static int switchdev_deferred_enqueue(struct net_device *dev,
83793f4014SJiri Pirko 				      const void *data, size_t data_len,
84793f4014SJiri Pirko 				      switchdev_deferred_func_t *func)
85793f4014SJiri Pirko {
86793f4014SJiri Pirko 	struct switchdev_deferred_item *dfitem;
87793f4014SJiri Pirko 
88d8c28581SMinghao Chi (CGEL ZTE) 	dfitem = kmalloc(struct_size(dfitem, data, data_len), GFP_ATOMIC);
89793f4014SJiri Pirko 	if (!dfitem)
90793f4014SJiri Pirko 		return -ENOMEM;
91793f4014SJiri Pirko 	dfitem->dev = dev;
92793f4014SJiri Pirko 	dfitem->func = func;
93793f4014SJiri Pirko 	memcpy(dfitem->data, data, data_len);
944fc003feSEric Dumazet 	dev_hold_track(dev, &dfitem->dev_tracker, GFP_ATOMIC);
95793f4014SJiri Pirko 	spin_lock_bh(&deferred_lock);
96793f4014SJiri Pirko 	list_add_tail(&dfitem->list, &deferred);
97793f4014SJiri Pirko 	spin_unlock_bh(&deferred_lock);
98793f4014SJiri Pirko 	schedule_work(&deferred_process_work);
99793f4014SJiri Pirko 	return 0;
100793f4014SJiri Pirko }
101793f4014SJiri Pirko 
102d45224d6SFlorian Fainelli static int switchdev_port_attr_notify(enum switchdev_notifier_type nt,
103d45224d6SFlorian Fainelli 				      struct net_device *dev,
104dcbdf135SVladimir Oltean 				      const struct switchdev_attr *attr,
105dcbdf135SVladimir Oltean 				      struct netlink_ext_ack *extack)
1063094333dSScott Feldman {
107d45224d6SFlorian Fainelli 	int err;
108d45224d6SFlorian Fainelli 	int rc;
1093094333dSScott Feldman 
110d45224d6SFlorian Fainelli 	struct switchdev_notifier_port_attr_info attr_info = {
111d45224d6SFlorian Fainelli 		.attr = attr,
112d45224d6SFlorian Fainelli 		.handled = false,
113d45224d6SFlorian Fainelli 	};
1143094333dSScott Feldman 
115d45224d6SFlorian Fainelli 	rc = call_switchdev_blocking_notifiers(nt, dev,
116dcbdf135SVladimir Oltean 					       &attr_info.info, extack);
117d45224d6SFlorian Fainelli 	err = notifier_to_errno(rc);
118d45224d6SFlorian Fainelli 	if (err) {
119d45224d6SFlorian Fainelli 		WARN_ON(!attr_info.handled);
1203094333dSScott Feldman 		return err;
1213094333dSScott Feldman 	}
1223094333dSScott Feldman 
123d45224d6SFlorian Fainelli 	if (!attr_info.handled)
124d45224d6SFlorian Fainelli 		return -EOPNOTSUPP;
125d45224d6SFlorian Fainelli 
126d45224d6SFlorian Fainelli 	return 0;
127d45224d6SFlorian Fainelli }
128d45224d6SFlorian Fainelli 
1290bc05d58SJiri Pirko static int switchdev_port_attr_set_now(struct net_device *dev,
130dcbdf135SVladimir Oltean 				       const struct switchdev_attr *attr,
131dcbdf135SVladimir Oltean 				       struct netlink_ext_ack *extack)
1323094333dSScott Feldman {
133dcbdf135SVladimir Oltean 	return switchdev_port_attr_notify(SWITCHDEV_PORT_ATTR_SET, dev, attr,
134dcbdf135SVladimir Oltean 					  extack);
1353094333dSScott Feldman }
1360bc05d58SJiri Pirko 
1370bc05d58SJiri Pirko static void switchdev_port_attr_set_deferred(struct net_device *dev,
1380bc05d58SJiri Pirko 					     const void *data)
1390bc05d58SJiri Pirko {
1400bc05d58SJiri Pirko 	const struct switchdev_attr *attr = data;
1410bc05d58SJiri Pirko 	int err;
1420bc05d58SJiri Pirko 
143dcbdf135SVladimir Oltean 	err = switchdev_port_attr_set_now(dev, attr, NULL);
1440bc05d58SJiri Pirko 	if (err && err != -EOPNOTSUPP)
1450bc05d58SJiri Pirko 		netdev_err(dev, "failed (err=%d) to set attribute (id=%d)\n",
1460bc05d58SJiri Pirko 			   err, attr->id);
1477ceb2afbSElad Raz 	if (attr->complete)
1487ceb2afbSElad Raz 		attr->complete(dev, err, attr->complete_priv);
1490bc05d58SJiri Pirko }
1500bc05d58SJiri Pirko 
1510bc05d58SJiri Pirko static int switchdev_port_attr_set_defer(struct net_device *dev,
1520bc05d58SJiri Pirko 					 const struct switchdev_attr *attr)
1530bc05d58SJiri Pirko {
1540bc05d58SJiri Pirko 	return switchdev_deferred_enqueue(dev, attr, sizeof(*attr),
1550bc05d58SJiri Pirko 					  switchdev_port_attr_set_deferred);
1560bc05d58SJiri Pirko }
1570bc05d58SJiri Pirko 
1580bc05d58SJiri Pirko /**
1590bc05d58SJiri Pirko  *	switchdev_port_attr_set - Set port attribute
1600bc05d58SJiri Pirko  *
1610bc05d58SJiri Pirko  *	@dev: port device
1620bc05d58SJiri Pirko  *	@attr: attribute to set
163dcbdf135SVladimir Oltean  *	@extack: netlink extended ack, for error message propagation
1640bc05d58SJiri Pirko  *
1650bc05d58SJiri Pirko  *	rtnl_lock must be held and must not be in atomic section,
1660bc05d58SJiri Pirko  *	in case SWITCHDEV_F_DEFER flag is not set.
1670bc05d58SJiri Pirko  */
1680bc05d58SJiri Pirko int switchdev_port_attr_set(struct net_device *dev,
169dcbdf135SVladimir Oltean 			    const struct switchdev_attr *attr,
170dcbdf135SVladimir Oltean 			    struct netlink_ext_ack *extack)
1710bc05d58SJiri Pirko {
1720bc05d58SJiri Pirko 	if (attr->flags & SWITCHDEV_F_DEFER)
1730bc05d58SJiri Pirko 		return switchdev_port_attr_set_defer(dev, attr);
1740bc05d58SJiri Pirko 	ASSERT_RTNL();
175dcbdf135SVladimir Oltean 	return switchdev_port_attr_set_now(dev, attr, extack);
1760bc05d58SJiri Pirko }
1773094333dSScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_attr_set);
1783094333dSScott Feldman 
179e258d919SScott Feldman static size_t switchdev_obj_size(const struct switchdev_obj *obj)
180e258d919SScott Feldman {
181e258d919SScott Feldman 	switch (obj->id) {
182e258d919SScott Feldman 	case SWITCHDEV_OBJ_ID_PORT_VLAN:
183e258d919SScott Feldman 		return sizeof(struct switchdev_obj_port_vlan);
1844d41e125SElad Raz 	case SWITCHDEV_OBJ_ID_PORT_MDB:
1854d41e125SElad Raz 		return sizeof(struct switchdev_obj_port_mdb);
18647d5b6dbSAndrew Lunn 	case SWITCHDEV_OBJ_ID_HOST_MDB:
18747d5b6dbSAndrew Lunn 		return sizeof(struct switchdev_obj_port_mdb);
188e258d919SScott Feldman 	default:
189e258d919SScott Feldman 		BUG();
190e258d919SScott Feldman 	}
191e258d919SScott Feldman 	return 0;
192e258d919SScott Feldman }
193e258d919SScott Feldman 
194d17d9f5eSPetr Machata static int switchdev_port_obj_notify(enum switchdev_notifier_type nt,
195d17d9f5eSPetr Machata 				     struct net_device *dev,
196648b4a99SJiri Pirko 				     const struct switchdev_obj *obj,
19769b7320eSPetr Machata 				     struct netlink_ext_ack *extack)
198491d0f15SScott Feldman {
199d17d9f5eSPetr Machata 	int rc;
200d17d9f5eSPetr Machata 	int err;
201491d0f15SScott Feldman 
202d17d9f5eSPetr Machata 	struct switchdev_notifier_port_obj_info obj_info = {
203d17d9f5eSPetr Machata 		.obj = obj,
204d17d9f5eSPetr Machata 		.handled = false,
205d17d9f5eSPetr Machata 	};
206491d0f15SScott Feldman 
207479c86dcSPetr Machata 	rc = call_switchdev_blocking_notifiers(nt, dev, &obj_info.info, extack);
208d17d9f5eSPetr Machata 	err = notifier_to_errno(rc);
209d17d9f5eSPetr Machata 	if (err) {
210d17d9f5eSPetr Machata 		WARN_ON(!obj_info.handled);
211491d0f15SScott Feldman 		return err;
212491d0f15SScott Feldman 	}
213d17d9f5eSPetr Machata 	if (!obj_info.handled)
214d17d9f5eSPetr Machata 		return -EOPNOTSUPP;
215d17d9f5eSPetr Machata 	return 0;
216d17d9f5eSPetr Machata }
217491d0f15SScott Feldman 
2184d429c5dSJiri Pirko static void switchdev_port_obj_add_deferred(struct net_device *dev,
2194d429c5dSJiri Pirko 					    const void *data)
2204d429c5dSJiri Pirko {
2214d429c5dSJiri Pirko 	const struct switchdev_obj *obj = data;
2224d429c5dSJiri Pirko 	int err;
2234d429c5dSJiri Pirko 
224cf6def51SVladimir Oltean 	ASSERT_RTNL();
225cf6def51SVladimir Oltean 	err = switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_ADD,
226cf6def51SVladimir Oltean 					dev, obj, NULL);
2274d429c5dSJiri Pirko 	if (err && err != -EOPNOTSUPP)
2284d429c5dSJiri Pirko 		netdev_err(dev, "failed (err=%d) to add object (id=%d)\n",
2294d429c5dSJiri Pirko 			   err, obj->id);
2307ceb2afbSElad Raz 	if (obj->complete)
2317ceb2afbSElad Raz 		obj->complete(dev, err, obj->complete_priv);
2324d429c5dSJiri Pirko }
2334d429c5dSJiri Pirko 
2344d429c5dSJiri Pirko static int switchdev_port_obj_add_defer(struct net_device *dev,
2354d429c5dSJiri Pirko 					const struct switchdev_obj *obj)
2364d429c5dSJiri Pirko {
237e258d919SScott Feldman 	return switchdev_deferred_enqueue(dev, obj, switchdev_obj_size(obj),
2384d429c5dSJiri Pirko 					  switchdev_port_obj_add_deferred);
2394d429c5dSJiri Pirko }
240491d0f15SScott Feldman 
241491d0f15SScott Feldman /**
2424d429c5dSJiri Pirko  *	switchdev_port_obj_add - Add port object
243491d0f15SScott Feldman  *
244491d0f15SScott Feldman  *	@dev: port device
2454d429c5dSJiri Pirko  *	@obj: object to add
246c8af73f0SAndrew Lunn  *	@extack: netlink extended ack
2474d429c5dSJiri Pirko  *
2484d429c5dSJiri Pirko  *	rtnl_lock must be held and must not be in atomic section,
2494d429c5dSJiri Pirko  *	in case SWITCHDEV_F_DEFER flag is not set.
250491d0f15SScott Feldman  */
2514d429c5dSJiri Pirko int switchdev_port_obj_add(struct net_device *dev,
25269b7320eSPetr Machata 			   const struct switchdev_obj *obj,
25369b7320eSPetr Machata 			   struct netlink_ext_ack *extack)
2544d429c5dSJiri Pirko {
2554d429c5dSJiri Pirko 	if (obj->flags & SWITCHDEV_F_DEFER)
2564d429c5dSJiri Pirko 		return switchdev_port_obj_add_defer(dev, obj);
2574d429c5dSJiri Pirko 	ASSERT_RTNL();
258cf6def51SVladimir Oltean 	return switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_ADD,
259cf6def51SVladimir Oltean 					 dev, obj, extack);
2604d429c5dSJiri Pirko }
2614d429c5dSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_port_obj_add);
2624d429c5dSJiri Pirko 
2634d429c5dSJiri Pirko static int switchdev_port_obj_del_now(struct net_device *dev,
264648b4a99SJiri Pirko 				      const struct switchdev_obj *obj)
265491d0f15SScott Feldman {
266d17d9f5eSPetr Machata 	return switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_DEL,
267ffb68fc5SVladimir Oltean 					 dev, obj, NULL);
268491d0f15SScott Feldman }
2694d429c5dSJiri Pirko 
2704d429c5dSJiri Pirko static void switchdev_port_obj_del_deferred(struct net_device *dev,
2714d429c5dSJiri Pirko 					    const void *data)
2724d429c5dSJiri Pirko {
2734d429c5dSJiri Pirko 	const struct switchdev_obj *obj = data;
2744d429c5dSJiri Pirko 	int err;
2754d429c5dSJiri Pirko 
2764d429c5dSJiri Pirko 	err = switchdev_port_obj_del_now(dev, obj);
2774d429c5dSJiri Pirko 	if (err && err != -EOPNOTSUPP)
2784d429c5dSJiri Pirko 		netdev_err(dev, "failed (err=%d) to del object (id=%d)\n",
2794d429c5dSJiri Pirko 			   err, obj->id);
2807ceb2afbSElad Raz 	if (obj->complete)
2817ceb2afbSElad Raz 		obj->complete(dev, err, obj->complete_priv);
2824d429c5dSJiri Pirko }
2834d429c5dSJiri Pirko 
2844d429c5dSJiri Pirko static int switchdev_port_obj_del_defer(struct net_device *dev,
2854d429c5dSJiri Pirko 					const struct switchdev_obj *obj)
2864d429c5dSJiri Pirko {
287e258d919SScott Feldman 	return switchdev_deferred_enqueue(dev, obj, switchdev_obj_size(obj),
2884d429c5dSJiri Pirko 					  switchdev_port_obj_del_deferred);
2894d429c5dSJiri Pirko }
2904d429c5dSJiri Pirko 
2914d429c5dSJiri Pirko /**
2924d429c5dSJiri Pirko  *	switchdev_port_obj_del - Delete port object
2934d429c5dSJiri Pirko  *
2944d429c5dSJiri Pirko  *	@dev: port device
2954d429c5dSJiri Pirko  *	@obj: object to delete
2964d429c5dSJiri Pirko  *
2974d429c5dSJiri Pirko  *	rtnl_lock must be held and must not be in atomic section,
2984d429c5dSJiri Pirko  *	in case SWITCHDEV_F_DEFER flag is not set.
2994d429c5dSJiri Pirko  */
3004d429c5dSJiri Pirko int switchdev_port_obj_del(struct net_device *dev,
3014d429c5dSJiri Pirko 			   const struct switchdev_obj *obj)
3024d429c5dSJiri Pirko {
3034d429c5dSJiri Pirko 	if (obj->flags & SWITCHDEV_F_DEFER)
3044d429c5dSJiri Pirko 		return switchdev_port_obj_del_defer(dev, obj);
3054d429c5dSJiri Pirko 	ASSERT_RTNL();
3064d429c5dSJiri Pirko 	return switchdev_port_obj_del_now(dev, obj);
3074d429c5dSJiri Pirko }
308491d0f15SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_obj_del);
309491d0f15SScott Feldman 
310ff5cf100SArkadi Sharshevsky static ATOMIC_NOTIFIER_HEAD(switchdev_notif_chain);
311a93e3b17SPetr Machata static BLOCKING_NOTIFIER_HEAD(switchdev_blocking_notif_chain);
31203bf0c28SJiri Pirko 
31303bf0c28SJiri Pirko /**
314ebb9a03aSJiri Pirko  *	register_switchdev_notifier - Register notifier
31503bf0c28SJiri Pirko  *	@nb: notifier_block
31603bf0c28SJiri Pirko  *
317ff5cf100SArkadi Sharshevsky  *	Register switch device notifier.
31803bf0c28SJiri Pirko  */
319ebb9a03aSJiri Pirko int register_switchdev_notifier(struct notifier_block *nb)
32003bf0c28SJiri Pirko {
321ff5cf100SArkadi Sharshevsky 	return atomic_notifier_chain_register(&switchdev_notif_chain, nb);
32203bf0c28SJiri Pirko }
323ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(register_switchdev_notifier);
32403bf0c28SJiri Pirko 
32503bf0c28SJiri Pirko /**
326ebb9a03aSJiri Pirko  *	unregister_switchdev_notifier - Unregister notifier
32703bf0c28SJiri Pirko  *	@nb: notifier_block
32803bf0c28SJiri Pirko  *
32903bf0c28SJiri Pirko  *	Unregister switch device notifier.
33003bf0c28SJiri Pirko  */
331ebb9a03aSJiri Pirko int unregister_switchdev_notifier(struct notifier_block *nb)
33203bf0c28SJiri Pirko {
333ff5cf100SArkadi Sharshevsky 	return atomic_notifier_chain_unregister(&switchdev_notif_chain, nb);
33403bf0c28SJiri Pirko }
335ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(unregister_switchdev_notifier);
33603bf0c28SJiri Pirko 
33703bf0c28SJiri Pirko /**
338ebb9a03aSJiri Pirko  *	call_switchdev_notifiers - Call notifiers
33903bf0c28SJiri Pirko  *	@val: value passed unmodified to notifier function
34003bf0c28SJiri Pirko  *	@dev: port device
34103bf0c28SJiri Pirko  *	@info: notifier information data
342ea6754aeSTian Tao  *	@extack: netlink extended ack
343ff5cf100SArkadi Sharshevsky  *	Call all network notifier blocks.
34403bf0c28SJiri Pirko  */
345ebb9a03aSJiri Pirko int call_switchdev_notifiers(unsigned long val, struct net_device *dev,
3466685987cSPetr Machata 			     struct switchdev_notifier_info *info,
3476685987cSPetr Machata 			     struct netlink_ext_ack *extack)
34803bf0c28SJiri Pirko {
34903bf0c28SJiri Pirko 	info->dev = dev;
3506685987cSPetr Machata 	info->extack = extack;
351ff5cf100SArkadi Sharshevsky 	return atomic_notifier_call_chain(&switchdev_notif_chain, val, info);
35203bf0c28SJiri Pirko }
353ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(call_switchdev_notifiers);
3548a44dbb2SRoopa Prabhu 
355a93e3b17SPetr Machata int register_switchdev_blocking_notifier(struct notifier_block *nb)
356a93e3b17SPetr Machata {
357a93e3b17SPetr Machata 	struct blocking_notifier_head *chain = &switchdev_blocking_notif_chain;
358a93e3b17SPetr Machata 
359a93e3b17SPetr Machata 	return blocking_notifier_chain_register(chain, nb);
360a93e3b17SPetr Machata }
361a93e3b17SPetr Machata EXPORT_SYMBOL_GPL(register_switchdev_blocking_notifier);
362a93e3b17SPetr Machata 
363a93e3b17SPetr Machata int unregister_switchdev_blocking_notifier(struct notifier_block *nb)
364a93e3b17SPetr Machata {
365a93e3b17SPetr Machata 	struct blocking_notifier_head *chain = &switchdev_blocking_notif_chain;
366a93e3b17SPetr Machata 
367a93e3b17SPetr Machata 	return blocking_notifier_chain_unregister(chain, nb);
368a93e3b17SPetr Machata }
369a93e3b17SPetr Machata EXPORT_SYMBOL_GPL(unregister_switchdev_blocking_notifier);
370a93e3b17SPetr Machata 
371a93e3b17SPetr Machata int call_switchdev_blocking_notifiers(unsigned long val, struct net_device *dev,
372479c86dcSPetr Machata 				      struct switchdev_notifier_info *info,
373479c86dcSPetr Machata 				      struct netlink_ext_ack *extack)
374a93e3b17SPetr Machata {
375a93e3b17SPetr Machata 	info->dev = dev;
376479c86dcSPetr Machata 	info->extack = extack;
377a93e3b17SPetr Machata 	return blocking_notifier_call_chain(&switchdev_blocking_notif_chain,
378a93e3b17SPetr Machata 					    val, info);
379a93e3b17SPetr Machata }
380a93e3b17SPetr Machata EXPORT_SYMBOL_GPL(call_switchdev_blocking_notifiers);
381a93e3b17SPetr Machata 
3822b0a5688SVladimir Oltean struct switchdev_nested_priv {
3832b0a5688SVladimir Oltean 	bool (*check_cb)(const struct net_device *dev);
3842b0a5688SVladimir Oltean 	bool (*foreign_dev_check_cb)(const struct net_device *dev,
3852b0a5688SVladimir Oltean 				     const struct net_device *foreign_dev);
3862b0a5688SVladimir Oltean 	const struct net_device *dev;
3872b0a5688SVladimir Oltean 	struct net_device *lower_dev;
3882b0a5688SVladimir Oltean };
3892b0a5688SVladimir Oltean 
3902b0a5688SVladimir Oltean static int switchdev_lower_dev_walk(struct net_device *lower_dev,
3912b0a5688SVladimir Oltean 				    struct netdev_nested_priv *priv)
3922b0a5688SVladimir Oltean {
3932b0a5688SVladimir Oltean 	struct switchdev_nested_priv *switchdev_priv = priv->data;
3942b0a5688SVladimir Oltean 	bool (*foreign_dev_check_cb)(const struct net_device *dev,
3952b0a5688SVladimir Oltean 				     const struct net_device *foreign_dev);
3962b0a5688SVladimir Oltean 	bool (*check_cb)(const struct net_device *dev);
3972b0a5688SVladimir Oltean 	const struct net_device *dev;
3982b0a5688SVladimir Oltean 
3992b0a5688SVladimir Oltean 	check_cb = switchdev_priv->check_cb;
4002b0a5688SVladimir Oltean 	foreign_dev_check_cb = switchdev_priv->foreign_dev_check_cb;
4012b0a5688SVladimir Oltean 	dev = switchdev_priv->dev;
4022b0a5688SVladimir Oltean 
4032b0a5688SVladimir Oltean 	if (check_cb(lower_dev) && !foreign_dev_check_cb(lower_dev, dev)) {
4042b0a5688SVladimir Oltean 		switchdev_priv->lower_dev = lower_dev;
4052b0a5688SVladimir Oltean 		return 1;
4062b0a5688SVladimir Oltean 	}
4072b0a5688SVladimir Oltean 
4082b0a5688SVladimir Oltean 	return 0;
4092b0a5688SVladimir Oltean }
4102b0a5688SVladimir Oltean 
4112b0a5688SVladimir Oltean static struct net_device *
4127b465f4cSVladimir Oltean switchdev_lower_dev_find_rcu(struct net_device *dev,
4132b0a5688SVladimir Oltean 			     bool (*check_cb)(const struct net_device *dev),
4142b0a5688SVladimir Oltean 			     bool (*foreign_dev_check_cb)(const struct net_device *dev,
4152b0a5688SVladimir Oltean 							  const struct net_device *foreign_dev))
4162b0a5688SVladimir Oltean {
4172b0a5688SVladimir Oltean 	struct switchdev_nested_priv switchdev_priv = {
4182b0a5688SVladimir Oltean 		.check_cb = check_cb,
4192b0a5688SVladimir Oltean 		.foreign_dev_check_cb = foreign_dev_check_cb,
4202b0a5688SVladimir Oltean 		.dev = dev,
4212b0a5688SVladimir Oltean 		.lower_dev = NULL,
4222b0a5688SVladimir Oltean 	};
4232b0a5688SVladimir Oltean 	struct netdev_nested_priv priv = {
4242b0a5688SVladimir Oltean 		.data = &switchdev_priv,
4252b0a5688SVladimir Oltean 	};
4262b0a5688SVladimir Oltean 
4272b0a5688SVladimir Oltean 	netdev_walk_all_lower_dev_rcu(dev, switchdev_lower_dev_walk, &priv);
4282b0a5688SVladimir Oltean 
4292b0a5688SVladimir Oltean 	return switchdev_priv.lower_dev;
4302b0a5688SVladimir Oltean }
4312b0a5688SVladimir Oltean 
432c4076cddSVladimir Oltean static struct net_device *
433c4076cddSVladimir Oltean switchdev_lower_dev_find(struct net_device *dev,
434c4076cddSVladimir Oltean 			 bool (*check_cb)(const struct net_device *dev),
435c4076cddSVladimir Oltean 			 bool (*foreign_dev_check_cb)(const struct net_device *dev,
436c4076cddSVladimir Oltean 						      const struct net_device *foreign_dev))
437c4076cddSVladimir Oltean {
438c4076cddSVladimir Oltean 	struct switchdev_nested_priv switchdev_priv = {
439c4076cddSVladimir Oltean 		.check_cb = check_cb,
440c4076cddSVladimir Oltean 		.foreign_dev_check_cb = foreign_dev_check_cb,
441c4076cddSVladimir Oltean 		.dev = dev,
442c4076cddSVladimir Oltean 		.lower_dev = NULL,
443c4076cddSVladimir Oltean 	};
444c4076cddSVladimir Oltean 	struct netdev_nested_priv priv = {
445c4076cddSVladimir Oltean 		.data = &switchdev_priv,
446c4076cddSVladimir Oltean 	};
447c4076cddSVladimir Oltean 
448c4076cddSVladimir Oltean 	netdev_walk_all_lower_dev(dev, switchdev_lower_dev_walk, &priv);
449c4076cddSVladimir Oltean 
450c4076cddSVladimir Oltean 	return switchdev_priv.lower_dev;
451c4076cddSVladimir Oltean }
452c4076cddSVladimir Oltean 
453716a30a9SVladimir Oltean static int __switchdev_handle_fdb_event_to_device(struct net_device *dev,
454716a30a9SVladimir Oltean 		struct net_device *orig_dev, unsigned long event,
4558ca07176SVladimir Oltean 		const struct switchdev_notifier_fdb_info *fdb_info,
4568ca07176SVladimir Oltean 		bool (*check_cb)(const struct net_device *dev),
4578ca07176SVladimir Oltean 		bool (*foreign_dev_check_cb)(const struct net_device *dev,
4588ca07176SVladimir Oltean 					     const struct net_device *foreign_dev),
459716a30a9SVladimir Oltean 		int (*mod_cb)(struct net_device *dev, struct net_device *orig_dev,
460716a30a9SVladimir Oltean 			      unsigned long event, const void *ctx,
4618ca07176SVladimir Oltean 			      const struct switchdev_notifier_fdb_info *fdb_info))
4628ca07176SVladimir Oltean {
4638ca07176SVladimir Oltean 	const struct switchdev_notifier_info *info = &fdb_info->info;
464*ec638740SVladimir Oltean 	struct net_device *br, *lower_dev, *switchdev;
4658ca07176SVladimir Oltean 	struct list_head *iter;
4668ca07176SVladimir Oltean 	int err = -EOPNOTSUPP;
4678ca07176SVladimir Oltean 
4682b0a5688SVladimir Oltean 	if (check_cb(dev))
469716a30a9SVladimir Oltean 		return mod_cb(dev, orig_dev, event, info->ctx, fdb_info);
4708ca07176SVladimir Oltean 
4718ca07176SVladimir Oltean 	/* Recurse through lower interfaces in case the FDB entry is pointing
472*ec638740SVladimir Oltean 	 * towards a bridge or a LAG device.
4738ca07176SVladimir Oltean 	 */
4748ca07176SVladimir Oltean 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
4758ca07176SVladimir Oltean 		/* Do not propagate FDB entries across bridges */
4768ca07176SVladimir Oltean 		if (netif_is_bridge_master(lower_dev))
4778ca07176SVladimir Oltean 			continue;
4788ca07176SVladimir Oltean 
4792b0a5688SVladimir Oltean 		/* Bridge ports might be either us, or LAG interfaces
4802b0a5688SVladimir Oltean 		 * that we offload.
4812b0a5688SVladimir Oltean 		 */
4822b0a5688SVladimir Oltean 		if (!check_cb(lower_dev) &&
4837b465f4cSVladimir Oltean 		    !switchdev_lower_dev_find_rcu(lower_dev, check_cb,
4842b0a5688SVladimir Oltean 						  foreign_dev_check_cb))
4852b0a5688SVladimir Oltean 			continue;
4862b0a5688SVladimir Oltean 
487716a30a9SVladimir Oltean 		err = __switchdev_handle_fdb_event_to_device(lower_dev, orig_dev,
488716a30a9SVladimir Oltean 							     event, fdb_info, check_cb,
4898ca07176SVladimir Oltean 							     foreign_dev_check_cb,
490*ec638740SVladimir Oltean 							     mod_cb);
4918ca07176SVladimir Oltean 		if (err && err != -EOPNOTSUPP)
4928ca07176SVladimir Oltean 			return err;
4938ca07176SVladimir Oltean 	}
4948ca07176SVladimir Oltean 
4952b0a5688SVladimir Oltean 	/* Event is neither on a bridge nor a LAG. Check whether it is on an
4962b0a5688SVladimir Oltean 	 * interface that is in a bridge with us.
4972b0a5688SVladimir Oltean 	 */
4982b0a5688SVladimir Oltean 	br = netdev_master_upper_dev_get_rcu(dev);
4992b0a5688SVladimir Oltean 	if (!br || !netif_is_bridge_master(br))
5002b0a5688SVladimir Oltean 		return 0;
5012b0a5688SVladimir Oltean 
502*ec638740SVladimir Oltean 	switchdev = switchdev_lower_dev_find_rcu(br, check_cb, foreign_dev_check_cb);
503*ec638740SVladimir Oltean 	if (!switchdev)
5042b0a5688SVladimir Oltean 		return 0;
5052b0a5688SVladimir Oltean 
506*ec638740SVladimir Oltean 	if (!foreign_dev_check_cb(switchdev, dev))
507*ec638740SVladimir Oltean 		return err;
508*ec638740SVladimir Oltean 
509716a30a9SVladimir Oltean 	return __switchdev_handle_fdb_event_to_device(br, orig_dev, event, fdb_info,
5102b0a5688SVladimir Oltean 						      check_cb, foreign_dev_check_cb,
511*ec638740SVladimir Oltean 						      mod_cb);
5128ca07176SVladimir Oltean }
5138ca07176SVladimir Oltean 
514716a30a9SVladimir Oltean int switchdev_handle_fdb_event_to_device(struct net_device *dev, unsigned long event,
5158ca07176SVladimir Oltean 		const struct switchdev_notifier_fdb_info *fdb_info,
5168ca07176SVladimir Oltean 		bool (*check_cb)(const struct net_device *dev),
5178ca07176SVladimir Oltean 		bool (*foreign_dev_check_cb)(const struct net_device *dev,
5188ca07176SVladimir Oltean 					     const struct net_device *foreign_dev),
519716a30a9SVladimir Oltean 		int (*mod_cb)(struct net_device *dev, struct net_device *orig_dev,
520716a30a9SVladimir Oltean 			      unsigned long event, const void *ctx,
5218ca07176SVladimir Oltean 			      const struct switchdev_notifier_fdb_info *fdb_info))
5228ca07176SVladimir Oltean {
5238ca07176SVladimir Oltean 	int err;
5248ca07176SVladimir Oltean 
525716a30a9SVladimir Oltean 	err = __switchdev_handle_fdb_event_to_device(dev, dev, event, fdb_info,
526716a30a9SVladimir Oltean 						     check_cb, foreign_dev_check_cb,
527*ec638740SVladimir Oltean 						     mod_cb);
5288ca07176SVladimir Oltean 	if (err == -EOPNOTSUPP)
5298ca07176SVladimir Oltean 		err = 0;
5308ca07176SVladimir Oltean 
5318ca07176SVladimir Oltean 	return err;
5328ca07176SVladimir Oltean }
533716a30a9SVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_handle_fdb_event_to_device);
5348ca07176SVladimir Oltean 
535f30f0601SPetr Machata static int __switchdev_handle_port_obj_add(struct net_device *dev,
536f30f0601SPetr Machata 			struct switchdev_notifier_port_obj_info *port_obj_info,
537f30f0601SPetr Machata 			bool (*check_cb)(const struct net_device *dev),
538c4076cddSVladimir Oltean 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
539c4076cddSVladimir Oltean 						     const struct net_device *foreign_dev),
54069bfac96SVladimir Oltean 			int (*add_cb)(struct net_device *dev, const void *ctx,
541f30f0601SPetr Machata 				      const struct switchdev_obj *obj,
54269213513SPetr Machata 				      struct netlink_ext_ack *extack))
543f30f0601SPetr Machata {
54469bfac96SVladimir Oltean 	struct switchdev_notifier_info *info = &port_obj_info->info;
545acd8df58SVladimir Oltean 	struct net_device *br, *lower_dev, *switchdev;
54669213513SPetr Machata 	struct netlink_ext_ack *extack;
547f30f0601SPetr Machata 	struct list_head *iter;
548f30f0601SPetr Machata 	int err = -EOPNOTSUPP;
549f30f0601SPetr Machata 
55069bfac96SVladimir Oltean 	extack = switchdev_notifier_info_to_extack(info);
55169213513SPetr Machata 
552f30f0601SPetr Machata 	if (check_cb(dev)) {
55369bfac96SVladimir Oltean 		err = add_cb(dev, info->ctx, port_obj_info->obj, extack);
55420776b46SRasmus Villemoes 		if (err != -EOPNOTSUPP)
555f30f0601SPetr Machata 			port_obj_info->handled = true;
55620776b46SRasmus Villemoes 		return err;
557f30f0601SPetr Machata 	}
558f30f0601SPetr Machata 
559f30f0601SPetr Machata 	/* Switch ports might be stacked under e.g. a LAG. Ignore the
560f30f0601SPetr Machata 	 * unsupported devices, another driver might be able to handle them. But
561f30f0601SPetr Machata 	 * propagate to the callers any hard errors.
562f30f0601SPetr Machata 	 *
563f30f0601SPetr Machata 	 * If the driver does its own bookkeeping of stacked ports, it's not
564f30f0601SPetr Machata 	 * necessary to go through this helper.
565f30f0601SPetr Machata 	 */
566f30f0601SPetr Machata 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
56707c6f980SRussell King 		if (netif_is_bridge_master(lower_dev))
56807c6f980SRussell King 			continue;
56907c6f980SRussell King 
570c4076cddSVladimir Oltean 		/* When searching for switchdev interfaces that are neighbors
571c4076cddSVladimir Oltean 		 * of foreign ones, and @dev is a bridge, do not recurse on the
572c4076cddSVladimir Oltean 		 * foreign interface again, it was already visited.
573c4076cddSVladimir Oltean 		 */
574c4076cddSVladimir Oltean 		if (foreign_dev_check_cb && !check_cb(lower_dev) &&
575c4076cddSVladimir Oltean 		    !switchdev_lower_dev_find(lower_dev, check_cb, foreign_dev_check_cb))
576c4076cddSVladimir Oltean 			continue;
577c4076cddSVladimir Oltean 
578f30f0601SPetr Machata 		err = __switchdev_handle_port_obj_add(lower_dev, port_obj_info,
579c4076cddSVladimir Oltean 						      check_cb, foreign_dev_check_cb,
580c4076cddSVladimir Oltean 						      add_cb);
581f30f0601SPetr Machata 		if (err && err != -EOPNOTSUPP)
582f30f0601SPetr Machata 			return err;
583f30f0601SPetr Machata 	}
584f30f0601SPetr Machata 
585c4076cddSVladimir Oltean 	/* Event is neither on a bridge nor a LAG. Check whether it is on an
586c4076cddSVladimir Oltean 	 * interface that is in a bridge with us.
587c4076cddSVladimir Oltean 	 */
588c4076cddSVladimir Oltean 	if (!foreign_dev_check_cb)
589f30f0601SPetr Machata 		return err;
590c4076cddSVladimir Oltean 
591c4076cddSVladimir Oltean 	br = netdev_master_upper_dev_get(dev);
592c4076cddSVladimir Oltean 	if (!br || !netif_is_bridge_master(br))
593c4076cddSVladimir Oltean 		return err;
594c4076cddSVladimir Oltean 
595acd8df58SVladimir Oltean 	switchdev = switchdev_lower_dev_find(br, check_cb, foreign_dev_check_cb);
596acd8df58SVladimir Oltean 	if (!switchdev)
597acd8df58SVladimir Oltean 		return err;
598acd8df58SVladimir Oltean 
599acd8df58SVladimir Oltean 	if (!foreign_dev_check_cb(switchdev, dev))
600c4076cddSVladimir Oltean 		return err;
601c4076cddSVladimir Oltean 
602c4076cddSVladimir Oltean 	return __switchdev_handle_port_obj_add(br, port_obj_info, check_cb,
603c4076cddSVladimir Oltean 					       foreign_dev_check_cb, add_cb);
604f30f0601SPetr Machata }
605f30f0601SPetr Machata 
606c4076cddSVladimir Oltean /* Pass through a port object addition, if @dev passes @check_cb, or replicate
607c4076cddSVladimir Oltean  * it towards all lower interfaces of @dev that pass @check_cb, if @dev is a
608c4076cddSVladimir Oltean  * bridge or a LAG.
609c4076cddSVladimir Oltean  */
610f30f0601SPetr Machata int switchdev_handle_port_obj_add(struct net_device *dev,
611f30f0601SPetr Machata 			struct switchdev_notifier_port_obj_info *port_obj_info,
612f30f0601SPetr Machata 			bool (*check_cb)(const struct net_device *dev),
61369bfac96SVladimir Oltean 			int (*add_cb)(struct net_device *dev, const void *ctx,
614f30f0601SPetr Machata 				      const struct switchdev_obj *obj,
61569213513SPetr Machata 				      struct netlink_ext_ack *extack))
616f30f0601SPetr Machata {
617f30f0601SPetr Machata 	int err;
618f30f0601SPetr Machata 
619f30f0601SPetr Machata 	err = __switchdev_handle_port_obj_add(dev, port_obj_info, check_cb,
620c4076cddSVladimir Oltean 					      NULL, add_cb);
621f30f0601SPetr Machata 	if (err == -EOPNOTSUPP)
622f30f0601SPetr Machata 		err = 0;
623f30f0601SPetr Machata 	return err;
624f30f0601SPetr Machata }
625f30f0601SPetr Machata EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_add);
626f30f0601SPetr Machata 
627c4076cddSVladimir Oltean /* Same as switchdev_handle_port_obj_add(), except if object is notified on a
628c4076cddSVladimir Oltean  * @dev that passes @foreign_dev_check_cb, it is replicated towards all devices
629c4076cddSVladimir Oltean  * that pass @check_cb and are in the same bridge as @dev.
630c4076cddSVladimir Oltean  */
631c4076cddSVladimir Oltean int switchdev_handle_port_obj_add_foreign(struct net_device *dev,
632c4076cddSVladimir Oltean 			struct switchdev_notifier_port_obj_info *port_obj_info,
633c4076cddSVladimir Oltean 			bool (*check_cb)(const struct net_device *dev),
634c4076cddSVladimir Oltean 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
635c4076cddSVladimir Oltean 						     const struct net_device *foreign_dev),
636c4076cddSVladimir Oltean 			int (*add_cb)(struct net_device *dev, const void *ctx,
637c4076cddSVladimir Oltean 				      const struct switchdev_obj *obj,
638c4076cddSVladimir Oltean 				      struct netlink_ext_ack *extack))
639c4076cddSVladimir Oltean {
640c4076cddSVladimir Oltean 	int err;
641c4076cddSVladimir Oltean 
642c4076cddSVladimir Oltean 	err = __switchdev_handle_port_obj_add(dev, port_obj_info, check_cb,
643c4076cddSVladimir Oltean 					      foreign_dev_check_cb, add_cb);
644c4076cddSVladimir Oltean 	if (err == -EOPNOTSUPP)
645c4076cddSVladimir Oltean 		err = 0;
646c4076cddSVladimir Oltean 	return err;
647c4076cddSVladimir Oltean }
648c4076cddSVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_add_foreign);
649c4076cddSVladimir Oltean 
650f30f0601SPetr Machata static int __switchdev_handle_port_obj_del(struct net_device *dev,
651f30f0601SPetr Machata 			struct switchdev_notifier_port_obj_info *port_obj_info,
652f30f0601SPetr Machata 			bool (*check_cb)(const struct net_device *dev),
653c4076cddSVladimir Oltean 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
654c4076cddSVladimir Oltean 						     const struct net_device *foreign_dev),
65569bfac96SVladimir Oltean 			int (*del_cb)(struct net_device *dev, const void *ctx,
656f30f0601SPetr Machata 				      const struct switchdev_obj *obj))
657f30f0601SPetr Machata {
65869bfac96SVladimir Oltean 	struct switchdev_notifier_info *info = &port_obj_info->info;
659acd8df58SVladimir Oltean 	struct net_device *br, *lower_dev, *switchdev;
660f30f0601SPetr Machata 	struct list_head *iter;
661f30f0601SPetr Machata 	int err = -EOPNOTSUPP;
662f30f0601SPetr Machata 
663f30f0601SPetr Machata 	if (check_cb(dev)) {
66469bfac96SVladimir Oltean 		err = del_cb(dev, info->ctx, port_obj_info->obj);
66520776b46SRasmus Villemoes 		if (err != -EOPNOTSUPP)
666f30f0601SPetr Machata 			port_obj_info->handled = true;
66720776b46SRasmus Villemoes 		return err;
668f30f0601SPetr Machata 	}
669f30f0601SPetr Machata 
670f30f0601SPetr Machata 	/* Switch ports might be stacked under e.g. a LAG. Ignore the
671f30f0601SPetr Machata 	 * unsupported devices, another driver might be able to handle them. But
672f30f0601SPetr Machata 	 * propagate to the callers any hard errors.
673f30f0601SPetr Machata 	 *
674f30f0601SPetr Machata 	 * If the driver does its own bookkeeping of stacked ports, it's not
675f30f0601SPetr Machata 	 * necessary to go through this helper.
676f30f0601SPetr Machata 	 */
677f30f0601SPetr Machata 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
67807c6f980SRussell King 		if (netif_is_bridge_master(lower_dev))
67907c6f980SRussell King 			continue;
68007c6f980SRussell King 
681c4076cddSVladimir Oltean 		/* When searching for switchdev interfaces that are neighbors
682c4076cddSVladimir Oltean 		 * of foreign ones, and @dev is a bridge, do not recurse on the
683c4076cddSVladimir Oltean 		 * foreign interface again, it was already visited.
684c4076cddSVladimir Oltean 		 */
685c4076cddSVladimir Oltean 		if (foreign_dev_check_cb && !check_cb(lower_dev) &&
686c4076cddSVladimir Oltean 		    !switchdev_lower_dev_find(lower_dev, check_cb, foreign_dev_check_cb))
687c4076cddSVladimir Oltean 			continue;
688c4076cddSVladimir Oltean 
689f30f0601SPetr Machata 		err = __switchdev_handle_port_obj_del(lower_dev, port_obj_info,
690c4076cddSVladimir Oltean 						      check_cb, foreign_dev_check_cb,
691c4076cddSVladimir Oltean 						      del_cb);
692f30f0601SPetr Machata 		if (err && err != -EOPNOTSUPP)
693f30f0601SPetr Machata 			return err;
694f30f0601SPetr Machata 	}
695f30f0601SPetr Machata 
696c4076cddSVladimir Oltean 	/* Event is neither on a bridge nor a LAG. Check whether it is on an
697c4076cddSVladimir Oltean 	 * interface that is in a bridge with us.
698c4076cddSVladimir Oltean 	 */
699c4076cddSVladimir Oltean 	if (!foreign_dev_check_cb)
700f30f0601SPetr Machata 		return err;
701c4076cddSVladimir Oltean 
702c4076cddSVladimir Oltean 	br = netdev_master_upper_dev_get(dev);
703c4076cddSVladimir Oltean 	if (!br || !netif_is_bridge_master(br))
704c4076cddSVladimir Oltean 		return err;
705c4076cddSVladimir Oltean 
706acd8df58SVladimir Oltean 	switchdev = switchdev_lower_dev_find(br, check_cb, foreign_dev_check_cb);
707acd8df58SVladimir Oltean 	if (!switchdev)
708acd8df58SVladimir Oltean 		return err;
709acd8df58SVladimir Oltean 
710acd8df58SVladimir Oltean 	if (!foreign_dev_check_cb(switchdev, dev))
711c4076cddSVladimir Oltean 		return err;
712c4076cddSVladimir Oltean 
713c4076cddSVladimir Oltean 	return __switchdev_handle_port_obj_del(br, port_obj_info, check_cb,
714c4076cddSVladimir Oltean 					       foreign_dev_check_cb, del_cb);
715f30f0601SPetr Machata }
716f30f0601SPetr Machata 
717c4076cddSVladimir Oltean /* Pass through a port object deletion, if @dev passes @check_cb, or replicate
718c4076cddSVladimir Oltean  * it towards all lower interfaces of @dev that pass @check_cb, if @dev is a
719c4076cddSVladimir Oltean  * bridge or a LAG.
720c4076cddSVladimir Oltean  */
721f30f0601SPetr Machata int switchdev_handle_port_obj_del(struct net_device *dev,
722f30f0601SPetr Machata 			struct switchdev_notifier_port_obj_info *port_obj_info,
723f30f0601SPetr Machata 			bool (*check_cb)(const struct net_device *dev),
72469bfac96SVladimir Oltean 			int (*del_cb)(struct net_device *dev, const void *ctx,
725f30f0601SPetr Machata 				      const struct switchdev_obj *obj))
726f30f0601SPetr Machata {
727f30f0601SPetr Machata 	int err;
728f30f0601SPetr Machata 
729f30f0601SPetr Machata 	err = __switchdev_handle_port_obj_del(dev, port_obj_info, check_cb,
730c4076cddSVladimir Oltean 					      NULL, del_cb);
731f30f0601SPetr Machata 	if (err == -EOPNOTSUPP)
732f30f0601SPetr Machata 		err = 0;
733f30f0601SPetr Machata 	return err;
734f30f0601SPetr Machata }
735f30f0601SPetr Machata EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_del);
7361cb33af1SFlorian Fainelli 
737c4076cddSVladimir Oltean /* Same as switchdev_handle_port_obj_del(), except if object is notified on a
738c4076cddSVladimir Oltean  * @dev that passes @foreign_dev_check_cb, it is replicated towards all devices
739c4076cddSVladimir Oltean  * that pass @check_cb and are in the same bridge as @dev.
740c4076cddSVladimir Oltean  */
741c4076cddSVladimir Oltean int switchdev_handle_port_obj_del_foreign(struct net_device *dev,
742c4076cddSVladimir Oltean 			struct switchdev_notifier_port_obj_info *port_obj_info,
743c4076cddSVladimir Oltean 			bool (*check_cb)(const struct net_device *dev),
744c4076cddSVladimir Oltean 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
745c4076cddSVladimir Oltean 						     const struct net_device *foreign_dev),
746c4076cddSVladimir Oltean 			int (*del_cb)(struct net_device *dev, const void *ctx,
747c4076cddSVladimir Oltean 				      const struct switchdev_obj *obj))
748c4076cddSVladimir Oltean {
749c4076cddSVladimir Oltean 	int err;
750c4076cddSVladimir Oltean 
751c4076cddSVladimir Oltean 	err = __switchdev_handle_port_obj_del(dev, port_obj_info, check_cb,
752c4076cddSVladimir Oltean 					      foreign_dev_check_cb, del_cb);
753c4076cddSVladimir Oltean 	if (err == -EOPNOTSUPP)
754c4076cddSVladimir Oltean 		err = 0;
755c4076cddSVladimir Oltean 	return err;
756c4076cddSVladimir Oltean }
757c4076cddSVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_del_foreign);
758c4076cddSVladimir Oltean 
7591cb33af1SFlorian Fainelli static int __switchdev_handle_port_attr_set(struct net_device *dev,
7601cb33af1SFlorian Fainelli 			struct switchdev_notifier_port_attr_info *port_attr_info,
7611cb33af1SFlorian Fainelli 			bool (*check_cb)(const struct net_device *dev),
76269bfac96SVladimir Oltean 			int (*set_cb)(struct net_device *dev, const void *ctx,
7634c08c586SVladimir Oltean 				      const struct switchdev_attr *attr,
7644c08c586SVladimir Oltean 				      struct netlink_ext_ack *extack))
7651cb33af1SFlorian Fainelli {
76669bfac96SVladimir Oltean 	struct switchdev_notifier_info *info = &port_attr_info->info;
7674c08c586SVladimir Oltean 	struct netlink_ext_ack *extack;
7681cb33af1SFlorian Fainelli 	struct net_device *lower_dev;
7691cb33af1SFlorian Fainelli 	struct list_head *iter;
7701cb33af1SFlorian Fainelli 	int err = -EOPNOTSUPP;
7711cb33af1SFlorian Fainelli 
77269bfac96SVladimir Oltean 	extack = switchdev_notifier_info_to_extack(info);
7734c08c586SVladimir Oltean 
7741cb33af1SFlorian Fainelli 	if (check_cb(dev)) {
77569bfac96SVladimir Oltean 		err = set_cb(dev, info->ctx, port_attr_info->attr, extack);
77620776b46SRasmus Villemoes 		if (err != -EOPNOTSUPP)
7771cb33af1SFlorian Fainelli 			port_attr_info->handled = true;
77820776b46SRasmus Villemoes 		return err;
7791cb33af1SFlorian Fainelli 	}
7801cb33af1SFlorian Fainelli 
7811cb33af1SFlorian Fainelli 	/* Switch ports might be stacked under e.g. a LAG. Ignore the
7821cb33af1SFlorian Fainelli 	 * unsupported devices, another driver might be able to handle them. But
7831cb33af1SFlorian Fainelli 	 * propagate to the callers any hard errors.
7841cb33af1SFlorian Fainelli 	 *
7851cb33af1SFlorian Fainelli 	 * If the driver does its own bookkeeping of stacked ports, it's not
7861cb33af1SFlorian Fainelli 	 * necessary to go through this helper.
7871cb33af1SFlorian Fainelli 	 */
7881cb33af1SFlorian Fainelli 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
78907c6f980SRussell King 		if (netif_is_bridge_master(lower_dev))
79007c6f980SRussell King 			continue;
79107c6f980SRussell King 
7921cb33af1SFlorian Fainelli 		err = __switchdev_handle_port_attr_set(lower_dev, port_attr_info,
7931cb33af1SFlorian Fainelli 						       check_cb, set_cb);
7941cb33af1SFlorian Fainelli 		if (err && err != -EOPNOTSUPP)
7951cb33af1SFlorian Fainelli 			return err;
7961cb33af1SFlorian Fainelli 	}
7971cb33af1SFlorian Fainelli 
7981cb33af1SFlorian Fainelli 	return err;
7991cb33af1SFlorian Fainelli }
8001cb33af1SFlorian Fainelli 
8011cb33af1SFlorian Fainelli int switchdev_handle_port_attr_set(struct net_device *dev,
8021cb33af1SFlorian Fainelli 			struct switchdev_notifier_port_attr_info *port_attr_info,
8031cb33af1SFlorian Fainelli 			bool (*check_cb)(const struct net_device *dev),
80469bfac96SVladimir Oltean 			int (*set_cb)(struct net_device *dev, const void *ctx,
8054c08c586SVladimir Oltean 				      const struct switchdev_attr *attr,
8064c08c586SVladimir Oltean 				      struct netlink_ext_ack *extack))
8071cb33af1SFlorian Fainelli {
8081cb33af1SFlorian Fainelli 	int err;
8091cb33af1SFlorian Fainelli 
8101cb33af1SFlorian Fainelli 	err = __switchdev_handle_port_attr_set(dev, port_attr_info, check_cb,
8111cb33af1SFlorian Fainelli 					       set_cb);
8121cb33af1SFlorian Fainelli 	if (err == -EOPNOTSUPP)
8131cb33af1SFlorian Fainelli 		err = 0;
8141cb33af1SFlorian Fainelli 	return err;
8151cb33af1SFlorian Fainelli }
8161cb33af1SFlorian Fainelli EXPORT_SYMBOL_GPL(switchdev_handle_port_attr_set);
817957e2235SVladimir Oltean 
818957e2235SVladimir Oltean int switchdev_bridge_port_offload(struct net_device *brport_dev,
819957e2235SVladimir Oltean 				  struct net_device *dev, const void *ctx,
820957e2235SVladimir Oltean 				  struct notifier_block *atomic_nb,
821957e2235SVladimir Oltean 				  struct notifier_block *blocking_nb,
822957e2235SVladimir Oltean 				  bool tx_fwd_offload,
823957e2235SVladimir Oltean 				  struct netlink_ext_ack *extack)
824957e2235SVladimir Oltean {
825957e2235SVladimir Oltean 	struct switchdev_notifier_brport_info brport_info = {
826957e2235SVladimir Oltean 		.brport = {
827957e2235SVladimir Oltean 			.dev = dev,
828957e2235SVladimir Oltean 			.ctx = ctx,
829957e2235SVladimir Oltean 			.atomic_nb = atomic_nb,
830957e2235SVladimir Oltean 			.blocking_nb = blocking_nb,
831957e2235SVladimir Oltean 			.tx_fwd_offload = tx_fwd_offload,
832957e2235SVladimir Oltean 		},
833957e2235SVladimir Oltean 	};
834957e2235SVladimir Oltean 	int err;
835957e2235SVladimir Oltean 
836957e2235SVladimir Oltean 	ASSERT_RTNL();
837957e2235SVladimir Oltean 
838957e2235SVladimir Oltean 	err = call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_OFFLOADED,
839957e2235SVladimir Oltean 						brport_dev, &brport_info.info,
840957e2235SVladimir Oltean 						extack);
841957e2235SVladimir Oltean 	return notifier_to_errno(err);
842957e2235SVladimir Oltean }
843957e2235SVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_bridge_port_offload);
844957e2235SVladimir Oltean 
845957e2235SVladimir Oltean void switchdev_bridge_port_unoffload(struct net_device *brport_dev,
846957e2235SVladimir Oltean 				     const void *ctx,
847957e2235SVladimir Oltean 				     struct notifier_block *atomic_nb,
848957e2235SVladimir Oltean 				     struct notifier_block *blocking_nb)
849957e2235SVladimir Oltean {
850957e2235SVladimir Oltean 	struct switchdev_notifier_brport_info brport_info = {
851957e2235SVladimir Oltean 		.brport = {
852957e2235SVladimir Oltean 			.ctx = ctx,
853957e2235SVladimir Oltean 			.atomic_nb = atomic_nb,
854957e2235SVladimir Oltean 			.blocking_nb = blocking_nb,
855957e2235SVladimir Oltean 		},
856957e2235SVladimir Oltean 	};
857957e2235SVladimir Oltean 
858957e2235SVladimir Oltean 	ASSERT_RTNL();
859957e2235SVladimir Oltean 
860957e2235SVladimir Oltean 	call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_UNOFFLOADED,
861957e2235SVladimir Oltean 					  brport_dev, &brport_info.info,
862957e2235SVladimir Oltean 					  NULL);
863957e2235SVladimir Oltean }
864957e2235SVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_bridge_port_unoffload);
865