1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * net/switchdev/switchdev.c - Switch device API
4  * Copyright (c) 2014-2015 Jiri Pirko <jiri@resnulli.us>
5  * Copyright (c) 2014-2015 Scott Feldman <sfeldma@gmail.com>
6  */
7 
8 #include <linux/kernel.h>
9 #include <linux/types.h>
10 #include <linux/init.h>
11 #include <linux/mutex.h>
12 #include <linux/notifier.h>
13 #include <linux/netdevice.h>
14 #include <linux/etherdevice.h>
15 #include <linux/if_bridge.h>
16 #include <linux/list.h>
17 #include <linux/workqueue.h>
18 #include <linux/if_vlan.h>
19 #include <linux/rtnetlink.h>
20 #include <net/switchdev.h>
21 
switchdev_obj_eq(const struct switchdev_obj * a,const struct switchdev_obj * b)22 static bool switchdev_obj_eq(const struct switchdev_obj *a,
23 			     const struct switchdev_obj *b)
24 {
25 	const struct switchdev_obj_port_vlan *va, *vb;
26 	const struct switchdev_obj_port_mdb *ma, *mb;
27 
28 	if (a->id != b->id || a->orig_dev != b->orig_dev)
29 		return false;
30 
31 	switch (a->id) {
32 	case SWITCHDEV_OBJ_ID_PORT_VLAN:
33 		va = SWITCHDEV_OBJ_PORT_VLAN(a);
34 		vb = SWITCHDEV_OBJ_PORT_VLAN(b);
35 		return va->flags == vb->flags &&
36 			va->vid == vb->vid &&
37 			va->changed == vb->changed;
38 	case SWITCHDEV_OBJ_ID_PORT_MDB:
39 	case SWITCHDEV_OBJ_ID_HOST_MDB:
40 		ma = SWITCHDEV_OBJ_PORT_MDB(a);
41 		mb = SWITCHDEV_OBJ_PORT_MDB(b);
42 		return ma->vid == mb->vid &&
43 			ether_addr_equal(ma->addr, mb->addr);
44 	default:
45 		break;
46 	}
47 
48 	BUG();
49 }
50 
51 static LIST_HEAD(deferred);
52 static DEFINE_SPINLOCK(deferred_lock);
53 
54 typedef void switchdev_deferred_func_t(struct net_device *dev,
55 				       const void *data);
56 
57 struct switchdev_deferred_item {
58 	struct list_head list;
59 	struct net_device *dev;
60 	netdevice_tracker dev_tracker;
61 	switchdev_deferred_func_t *func;
62 	unsigned long data[];
63 };
64 
switchdev_deferred_dequeue(void)65 static struct switchdev_deferred_item *switchdev_deferred_dequeue(void)
66 {
67 	struct switchdev_deferred_item *dfitem;
68 
69 	spin_lock_bh(&deferred_lock);
70 	if (list_empty(&deferred)) {
71 		dfitem = NULL;
72 		goto unlock;
73 	}
74 	dfitem = list_first_entry(&deferred,
75 				  struct switchdev_deferred_item, list);
76 	list_del(&dfitem->list);
77 unlock:
78 	spin_unlock_bh(&deferred_lock);
79 	return dfitem;
80 }
81 
82 /**
83  *	switchdev_deferred_process - Process ops in deferred queue
84  *
85  *	Called to flush the ops currently queued in deferred ops queue.
86  *	rtnl_lock must be held.
87  */
switchdev_deferred_process(void)88 void switchdev_deferred_process(void)
89 {
90 	struct switchdev_deferred_item *dfitem;
91 
92 	ASSERT_RTNL();
93 
94 	while ((dfitem = switchdev_deferred_dequeue())) {
95 		dfitem->func(dfitem->dev, dfitem->data);
96 		netdev_put(dfitem->dev, &dfitem->dev_tracker);
97 		kfree(dfitem);
98 	}
99 }
100 EXPORT_SYMBOL_GPL(switchdev_deferred_process);
101 
switchdev_deferred_process_work(struct work_struct * work)102 static void switchdev_deferred_process_work(struct work_struct *work)
103 {
104 	rtnl_lock();
105 	switchdev_deferred_process();
106 	rtnl_unlock();
107 }
108 
109 static DECLARE_WORK(deferred_process_work, switchdev_deferred_process_work);
110 
switchdev_deferred_enqueue(struct net_device * dev,const void * data,size_t data_len,switchdev_deferred_func_t * func)111 static int switchdev_deferred_enqueue(struct net_device *dev,
112 				      const void *data, size_t data_len,
113 				      switchdev_deferred_func_t *func)
114 {
115 	struct switchdev_deferred_item *dfitem;
116 
117 	dfitem = kmalloc(struct_size(dfitem, data, data_len), GFP_ATOMIC);
118 	if (!dfitem)
119 		return -ENOMEM;
120 	dfitem->dev = dev;
121 	dfitem->func = func;
122 	memcpy(dfitem->data, data, data_len);
123 	netdev_hold(dev, &dfitem->dev_tracker, GFP_ATOMIC);
124 	spin_lock_bh(&deferred_lock);
125 	list_add_tail(&dfitem->list, &deferred);
126 	spin_unlock_bh(&deferred_lock);
127 	schedule_work(&deferred_process_work);
128 	return 0;
129 }
130 
switchdev_port_attr_notify(enum switchdev_notifier_type nt,struct net_device * dev,const struct switchdev_attr * attr,struct netlink_ext_ack * extack)131 static int switchdev_port_attr_notify(enum switchdev_notifier_type nt,
132 				      struct net_device *dev,
133 				      const struct switchdev_attr *attr,
134 				      struct netlink_ext_ack *extack)
135 {
136 	int err;
137 	int rc;
138 
139 	struct switchdev_notifier_port_attr_info attr_info = {
140 		.attr = attr,
141 		.handled = false,
142 	};
143 
144 	rc = call_switchdev_blocking_notifiers(nt, dev,
145 					       &attr_info.info, extack);
146 	err = notifier_to_errno(rc);
147 	if (err) {
148 		WARN_ON(!attr_info.handled);
149 		return err;
150 	}
151 
152 	if (!attr_info.handled)
153 		return -EOPNOTSUPP;
154 
155 	return 0;
156 }
157 
switchdev_port_attr_set_now(struct net_device * dev,const struct switchdev_attr * attr,struct netlink_ext_ack * extack)158 static int switchdev_port_attr_set_now(struct net_device *dev,
159 				       const struct switchdev_attr *attr,
160 				       struct netlink_ext_ack *extack)
161 {
162 	return switchdev_port_attr_notify(SWITCHDEV_PORT_ATTR_SET, dev, attr,
163 					  extack);
164 }
165 
switchdev_port_attr_set_deferred(struct net_device * dev,const void * data)166 static void switchdev_port_attr_set_deferred(struct net_device *dev,
167 					     const void *data)
168 {
169 	const struct switchdev_attr *attr = data;
170 	int err;
171 
172 	err = switchdev_port_attr_set_now(dev, attr, NULL);
173 	if (err && err != -EOPNOTSUPP)
174 		netdev_err(dev, "failed (err=%d) to set attribute (id=%d)\n",
175 			   err, attr->id);
176 	if (attr->complete)
177 		attr->complete(dev, err, attr->complete_priv);
178 }
179 
switchdev_port_attr_set_defer(struct net_device * dev,const struct switchdev_attr * attr)180 static int switchdev_port_attr_set_defer(struct net_device *dev,
181 					 const struct switchdev_attr *attr)
182 {
183 	return switchdev_deferred_enqueue(dev, attr, sizeof(*attr),
184 					  switchdev_port_attr_set_deferred);
185 }
186 
187 /**
188  *	switchdev_port_attr_set - Set port attribute
189  *
190  *	@dev: port device
191  *	@attr: attribute to set
192  *	@extack: netlink extended ack, for error message propagation
193  *
194  *	rtnl_lock must be held and must not be in atomic section,
195  *	in case SWITCHDEV_F_DEFER flag is not set.
196  */
switchdev_port_attr_set(struct net_device * dev,const struct switchdev_attr * attr,struct netlink_ext_ack * extack)197 int switchdev_port_attr_set(struct net_device *dev,
198 			    const struct switchdev_attr *attr,
199 			    struct netlink_ext_ack *extack)
200 {
201 	if (attr->flags & SWITCHDEV_F_DEFER)
202 		return switchdev_port_attr_set_defer(dev, attr);
203 	ASSERT_RTNL();
204 	return switchdev_port_attr_set_now(dev, attr, extack);
205 }
206 EXPORT_SYMBOL_GPL(switchdev_port_attr_set);
207 
switchdev_obj_size(const struct switchdev_obj * obj)208 static size_t switchdev_obj_size(const struct switchdev_obj *obj)
209 {
210 	switch (obj->id) {
211 	case SWITCHDEV_OBJ_ID_PORT_VLAN:
212 		return sizeof(struct switchdev_obj_port_vlan);
213 	case SWITCHDEV_OBJ_ID_PORT_MDB:
214 		return sizeof(struct switchdev_obj_port_mdb);
215 	case SWITCHDEV_OBJ_ID_HOST_MDB:
216 		return sizeof(struct switchdev_obj_port_mdb);
217 	default:
218 		BUG();
219 	}
220 	return 0;
221 }
222 
switchdev_port_obj_notify(enum switchdev_notifier_type nt,struct net_device * dev,const struct switchdev_obj * obj,struct netlink_ext_ack * extack)223 static int switchdev_port_obj_notify(enum switchdev_notifier_type nt,
224 				     struct net_device *dev,
225 				     const struct switchdev_obj *obj,
226 				     struct netlink_ext_ack *extack)
227 {
228 	int rc;
229 	int err;
230 
231 	struct switchdev_notifier_port_obj_info obj_info = {
232 		.obj = obj,
233 		.handled = false,
234 	};
235 
236 	rc = call_switchdev_blocking_notifiers(nt, dev, &obj_info.info, extack);
237 	err = notifier_to_errno(rc);
238 	if (err) {
239 		WARN_ON(!obj_info.handled);
240 		return err;
241 	}
242 	if (!obj_info.handled)
243 		return -EOPNOTSUPP;
244 	return 0;
245 }
246 
switchdev_port_obj_add_deferred(struct net_device * dev,const void * data)247 static void switchdev_port_obj_add_deferred(struct net_device *dev,
248 					    const void *data)
249 {
250 	const struct switchdev_obj *obj = data;
251 	int err;
252 
253 	ASSERT_RTNL();
254 	err = switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_ADD,
255 					dev, obj, NULL);
256 	if (err && err != -EOPNOTSUPP)
257 		netdev_err(dev, "failed (err=%d) to add object (id=%d)\n",
258 			   err, obj->id);
259 	if (obj->complete)
260 		obj->complete(dev, err, obj->complete_priv);
261 }
262 
switchdev_port_obj_add_defer(struct net_device * dev,const struct switchdev_obj * obj)263 static int switchdev_port_obj_add_defer(struct net_device *dev,
264 					const struct switchdev_obj *obj)
265 {
266 	return switchdev_deferred_enqueue(dev, obj, switchdev_obj_size(obj),
267 					  switchdev_port_obj_add_deferred);
268 }
269 
270 /**
271  *	switchdev_port_obj_add - Add port object
272  *
273  *	@dev: port device
274  *	@obj: object to add
275  *	@extack: netlink extended ack
276  *
277  *	rtnl_lock must be held and must not be in atomic section,
278  *	in case SWITCHDEV_F_DEFER flag is not set.
279  */
switchdev_port_obj_add(struct net_device * dev,const struct switchdev_obj * obj,struct netlink_ext_ack * extack)280 int switchdev_port_obj_add(struct net_device *dev,
281 			   const struct switchdev_obj *obj,
282 			   struct netlink_ext_ack *extack)
283 {
284 	if (obj->flags & SWITCHDEV_F_DEFER)
285 		return switchdev_port_obj_add_defer(dev, obj);
286 	ASSERT_RTNL();
287 	return switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_ADD,
288 					 dev, obj, extack);
289 }
290 EXPORT_SYMBOL_GPL(switchdev_port_obj_add);
291 
switchdev_port_obj_del_now(struct net_device * dev,const struct switchdev_obj * obj)292 static int switchdev_port_obj_del_now(struct net_device *dev,
293 				      const struct switchdev_obj *obj)
294 {
295 	return switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_DEL,
296 					 dev, obj, NULL);
297 }
298 
switchdev_port_obj_del_deferred(struct net_device * dev,const void * data)299 static void switchdev_port_obj_del_deferred(struct net_device *dev,
300 					    const void *data)
301 {
302 	const struct switchdev_obj *obj = data;
303 	int err;
304 
305 	err = switchdev_port_obj_del_now(dev, obj);
306 	if (err && err != -EOPNOTSUPP)
307 		netdev_err(dev, "failed (err=%d) to del object (id=%d)\n",
308 			   err, obj->id);
309 	if (obj->complete)
310 		obj->complete(dev, err, obj->complete_priv);
311 }
312 
switchdev_port_obj_del_defer(struct net_device * dev,const struct switchdev_obj * obj)313 static int switchdev_port_obj_del_defer(struct net_device *dev,
314 					const struct switchdev_obj *obj)
315 {
316 	return switchdev_deferred_enqueue(dev, obj, switchdev_obj_size(obj),
317 					  switchdev_port_obj_del_deferred);
318 }
319 
320 /**
321  *	switchdev_port_obj_del - Delete port object
322  *
323  *	@dev: port device
324  *	@obj: object to delete
325  *
326  *	rtnl_lock must be held and must not be in atomic section,
327  *	in case SWITCHDEV_F_DEFER flag is not set.
328  */
switchdev_port_obj_del(struct net_device * dev,const struct switchdev_obj * obj)329 int switchdev_port_obj_del(struct net_device *dev,
330 			   const struct switchdev_obj *obj)
331 {
332 	if (obj->flags & SWITCHDEV_F_DEFER)
333 		return switchdev_port_obj_del_defer(dev, obj);
334 	ASSERT_RTNL();
335 	return switchdev_port_obj_del_now(dev, obj);
336 }
337 EXPORT_SYMBOL_GPL(switchdev_port_obj_del);
338 
339 /**
340  *	switchdev_port_obj_act_is_deferred - Is object action pending?
341  *
342  *	@dev: port device
343  *	@nt: type of action; add or delete
344  *	@obj: object to test
345  *
346  *	Returns true if a deferred item is pending, which is
347  *	equivalent to the action @nt on an object @obj.
348  *
349  *	rtnl_lock must be held.
350  */
switchdev_port_obj_act_is_deferred(struct net_device * dev,enum switchdev_notifier_type nt,const struct switchdev_obj * obj)351 bool switchdev_port_obj_act_is_deferred(struct net_device *dev,
352 					enum switchdev_notifier_type nt,
353 					const struct switchdev_obj *obj)
354 {
355 	struct switchdev_deferred_item *dfitem;
356 	bool found = false;
357 
358 	ASSERT_RTNL();
359 
360 	spin_lock_bh(&deferred_lock);
361 
362 	list_for_each_entry(dfitem, &deferred, list) {
363 		if (dfitem->dev != dev)
364 			continue;
365 
366 		if ((dfitem->func == switchdev_port_obj_add_deferred &&
367 		     nt == SWITCHDEV_PORT_OBJ_ADD) ||
368 		    (dfitem->func == switchdev_port_obj_del_deferred &&
369 		     nt == SWITCHDEV_PORT_OBJ_DEL)) {
370 			if (switchdev_obj_eq((const void *)dfitem->data, obj)) {
371 				found = true;
372 				break;
373 			}
374 		}
375 	}
376 
377 	spin_unlock_bh(&deferred_lock);
378 
379 	return found;
380 }
381 EXPORT_SYMBOL_GPL(switchdev_port_obj_act_is_deferred);
382 
383 static ATOMIC_NOTIFIER_HEAD(switchdev_notif_chain);
384 static BLOCKING_NOTIFIER_HEAD(switchdev_blocking_notif_chain);
385 
386 /**
387  *	register_switchdev_notifier - Register notifier
388  *	@nb: notifier_block
389  *
390  *	Register switch device notifier.
391  */
register_switchdev_notifier(struct notifier_block * nb)392 int register_switchdev_notifier(struct notifier_block *nb)
393 {
394 	return atomic_notifier_chain_register(&switchdev_notif_chain, nb);
395 }
396 EXPORT_SYMBOL_GPL(register_switchdev_notifier);
397 
398 /**
399  *	unregister_switchdev_notifier - Unregister notifier
400  *	@nb: notifier_block
401  *
402  *	Unregister switch device notifier.
403  */
unregister_switchdev_notifier(struct notifier_block * nb)404 int unregister_switchdev_notifier(struct notifier_block *nb)
405 {
406 	return atomic_notifier_chain_unregister(&switchdev_notif_chain, nb);
407 }
408 EXPORT_SYMBOL_GPL(unregister_switchdev_notifier);
409 
410 /**
411  *	call_switchdev_notifiers - Call notifiers
412  *	@val: value passed unmodified to notifier function
413  *	@dev: port device
414  *	@info: notifier information data
415  *	@extack: netlink extended ack
416  *	Call all network notifier blocks.
417  */
call_switchdev_notifiers(unsigned long val,struct net_device * dev,struct switchdev_notifier_info * info,struct netlink_ext_ack * extack)418 int call_switchdev_notifiers(unsigned long val, struct net_device *dev,
419 			     struct switchdev_notifier_info *info,
420 			     struct netlink_ext_ack *extack)
421 {
422 	info->dev = dev;
423 	info->extack = extack;
424 	return atomic_notifier_call_chain(&switchdev_notif_chain, val, info);
425 }
426 EXPORT_SYMBOL_GPL(call_switchdev_notifiers);
427 
register_switchdev_blocking_notifier(struct notifier_block * nb)428 int register_switchdev_blocking_notifier(struct notifier_block *nb)
429 {
430 	struct blocking_notifier_head *chain = &switchdev_blocking_notif_chain;
431 
432 	return blocking_notifier_chain_register(chain, nb);
433 }
434 EXPORT_SYMBOL_GPL(register_switchdev_blocking_notifier);
435 
unregister_switchdev_blocking_notifier(struct notifier_block * nb)436 int unregister_switchdev_blocking_notifier(struct notifier_block *nb)
437 {
438 	struct blocking_notifier_head *chain = &switchdev_blocking_notif_chain;
439 
440 	return blocking_notifier_chain_unregister(chain, nb);
441 }
442 EXPORT_SYMBOL_GPL(unregister_switchdev_blocking_notifier);
443 
call_switchdev_blocking_notifiers(unsigned long val,struct net_device * dev,struct switchdev_notifier_info * info,struct netlink_ext_ack * extack)444 int call_switchdev_blocking_notifiers(unsigned long val, struct net_device *dev,
445 				      struct switchdev_notifier_info *info,
446 				      struct netlink_ext_ack *extack)
447 {
448 	info->dev = dev;
449 	info->extack = extack;
450 	return blocking_notifier_call_chain(&switchdev_blocking_notif_chain,
451 					    val, info);
452 }
453 EXPORT_SYMBOL_GPL(call_switchdev_blocking_notifiers);
454 
455 struct switchdev_nested_priv {
456 	bool (*check_cb)(const struct net_device *dev);
457 	bool (*foreign_dev_check_cb)(const struct net_device *dev,
458 				     const struct net_device *foreign_dev);
459 	const struct net_device *dev;
460 	struct net_device *lower_dev;
461 };
462 
switchdev_lower_dev_walk(struct net_device * lower_dev,struct netdev_nested_priv * priv)463 static int switchdev_lower_dev_walk(struct net_device *lower_dev,
464 				    struct netdev_nested_priv *priv)
465 {
466 	struct switchdev_nested_priv *switchdev_priv = priv->data;
467 	bool (*foreign_dev_check_cb)(const struct net_device *dev,
468 				     const struct net_device *foreign_dev);
469 	bool (*check_cb)(const struct net_device *dev);
470 	const struct net_device *dev;
471 
472 	check_cb = switchdev_priv->check_cb;
473 	foreign_dev_check_cb = switchdev_priv->foreign_dev_check_cb;
474 	dev = switchdev_priv->dev;
475 
476 	if (check_cb(lower_dev) && !foreign_dev_check_cb(lower_dev, dev)) {
477 		switchdev_priv->lower_dev = lower_dev;
478 		return 1;
479 	}
480 
481 	return 0;
482 }
483 
484 static struct net_device *
switchdev_lower_dev_find_rcu(struct net_device * dev,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev))485 switchdev_lower_dev_find_rcu(struct net_device *dev,
486 			     bool (*check_cb)(const struct net_device *dev),
487 			     bool (*foreign_dev_check_cb)(const struct net_device *dev,
488 							  const struct net_device *foreign_dev))
489 {
490 	struct switchdev_nested_priv switchdev_priv = {
491 		.check_cb = check_cb,
492 		.foreign_dev_check_cb = foreign_dev_check_cb,
493 		.dev = dev,
494 		.lower_dev = NULL,
495 	};
496 	struct netdev_nested_priv priv = {
497 		.data = &switchdev_priv,
498 	};
499 
500 	netdev_walk_all_lower_dev_rcu(dev, switchdev_lower_dev_walk, &priv);
501 
502 	return switchdev_priv.lower_dev;
503 }
504 
505 static struct net_device *
switchdev_lower_dev_find(struct net_device * dev,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev))506 switchdev_lower_dev_find(struct net_device *dev,
507 			 bool (*check_cb)(const struct net_device *dev),
508 			 bool (*foreign_dev_check_cb)(const struct net_device *dev,
509 						      const struct net_device *foreign_dev))
510 {
511 	struct switchdev_nested_priv switchdev_priv = {
512 		.check_cb = check_cb,
513 		.foreign_dev_check_cb = foreign_dev_check_cb,
514 		.dev = dev,
515 		.lower_dev = NULL,
516 	};
517 	struct netdev_nested_priv priv = {
518 		.data = &switchdev_priv,
519 	};
520 
521 	netdev_walk_all_lower_dev(dev, switchdev_lower_dev_walk, &priv);
522 
523 	return switchdev_priv.lower_dev;
524 }
525 
__switchdev_handle_fdb_event_to_device(struct net_device * dev,struct net_device * orig_dev,unsigned long event,const struct switchdev_notifier_fdb_info * fdb_info,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev),int (* mod_cb)(struct net_device * dev,struct net_device * orig_dev,unsigned long event,const void * ctx,const struct switchdev_notifier_fdb_info * fdb_info))526 static int __switchdev_handle_fdb_event_to_device(struct net_device *dev,
527 		struct net_device *orig_dev, unsigned long event,
528 		const struct switchdev_notifier_fdb_info *fdb_info,
529 		bool (*check_cb)(const struct net_device *dev),
530 		bool (*foreign_dev_check_cb)(const struct net_device *dev,
531 					     const struct net_device *foreign_dev),
532 		int (*mod_cb)(struct net_device *dev, struct net_device *orig_dev,
533 			      unsigned long event, const void *ctx,
534 			      const struct switchdev_notifier_fdb_info *fdb_info))
535 {
536 	const struct switchdev_notifier_info *info = &fdb_info->info;
537 	struct net_device *br, *lower_dev, *switchdev;
538 	struct list_head *iter;
539 	int err = -EOPNOTSUPP;
540 
541 	if (check_cb(dev))
542 		return mod_cb(dev, orig_dev, event, info->ctx, fdb_info);
543 
544 	/* Recurse through lower interfaces in case the FDB entry is pointing
545 	 * towards a bridge or a LAG device.
546 	 */
547 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
548 		/* Do not propagate FDB entries across bridges */
549 		if (netif_is_bridge_master(lower_dev))
550 			continue;
551 
552 		/* Bridge ports might be either us, or LAG interfaces
553 		 * that we offload.
554 		 */
555 		if (!check_cb(lower_dev) &&
556 		    !switchdev_lower_dev_find_rcu(lower_dev, check_cb,
557 						  foreign_dev_check_cb))
558 			continue;
559 
560 		err = __switchdev_handle_fdb_event_to_device(lower_dev, orig_dev,
561 							     event, fdb_info, check_cb,
562 							     foreign_dev_check_cb,
563 							     mod_cb);
564 		if (err && err != -EOPNOTSUPP)
565 			return err;
566 	}
567 
568 	/* Event is neither on a bridge nor a LAG. Check whether it is on an
569 	 * interface that is in a bridge with us.
570 	 */
571 	br = netdev_master_upper_dev_get_rcu(dev);
572 	if (!br || !netif_is_bridge_master(br))
573 		return 0;
574 
575 	switchdev = switchdev_lower_dev_find_rcu(br, check_cb, foreign_dev_check_cb);
576 	if (!switchdev)
577 		return 0;
578 
579 	if (!foreign_dev_check_cb(switchdev, dev))
580 		return err;
581 
582 	return __switchdev_handle_fdb_event_to_device(br, orig_dev, event, fdb_info,
583 						      check_cb, foreign_dev_check_cb,
584 						      mod_cb);
585 }
586 
switchdev_handle_fdb_event_to_device(struct net_device * dev,unsigned long event,const struct switchdev_notifier_fdb_info * fdb_info,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev),int (* mod_cb)(struct net_device * dev,struct net_device * orig_dev,unsigned long event,const void * ctx,const struct switchdev_notifier_fdb_info * fdb_info))587 int switchdev_handle_fdb_event_to_device(struct net_device *dev, unsigned long event,
588 		const struct switchdev_notifier_fdb_info *fdb_info,
589 		bool (*check_cb)(const struct net_device *dev),
590 		bool (*foreign_dev_check_cb)(const struct net_device *dev,
591 					     const struct net_device *foreign_dev),
592 		int (*mod_cb)(struct net_device *dev, struct net_device *orig_dev,
593 			      unsigned long event, const void *ctx,
594 			      const struct switchdev_notifier_fdb_info *fdb_info))
595 {
596 	int err;
597 
598 	err = __switchdev_handle_fdb_event_to_device(dev, dev, event, fdb_info,
599 						     check_cb, foreign_dev_check_cb,
600 						     mod_cb);
601 	if (err == -EOPNOTSUPP)
602 		err = 0;
603 
604 	return err;
605 }
606 EXPORT_SYMBOL_GPL(switchdev_handle_fdb_event_to_device);
607 
__switchdev_handle_port_obj_add(struct net_device * dev,struct switchdev_notifier_port_obj_info * port_obj_info,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev),int (* add_cb)(struct net_device * dev,const void * ctx,const struct switchdev_obj * obj,struct netlink_ext_ack * extack))608 static int __switchdev_handle_port_obj_add(struct net_device *dev,
609 			struct switchdev_notifier_port_obj_info *port_obj_info,
610 			bool (*check_cb)(const struct net_device *dev),
611 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
612 						     const struct net_device *foreign_dev),
613 			int (*add_cb)(struct net_device *dev, const void *ctx,
614 				      const struct switchdev_obj *obj,
615 				      struct netlink_ext_ack *extack))
616 {
617 	struct switchdev_notifier_info *info = &port_obj_info->info;
618 	struct net_device *br, *lower_dev, *switchdev;
619 	struct netlink_ext_ack *extack;
620 	struct list_head *iter;
621 	int err = -EOPNOTSUPP;
622 
623 	extack = switchdev_notifier_info_to_extack(info);
624 
625 	if (check_cb(dev)) {
626 		err = add_cb(dev, info->ctx, port_obj_info->obj, extack);
627 		if (err != -EOPNOTSUPP)
628 			port_obj_info->handled = true;
629 		return err;
630 	}
631 
632 	/* Switch ports might be stacked under e.g. a LAG. Ignore the
633 	 * unsupported devices, another driver might be able to handle them. But
634 	 * propagate to the callers any hard errors.
635 	 *
636 	 * If the driver does its own bookkeeping of stacked ports, it's not
637 	 * necessary to go through this helper.
638 	 */
639 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
640 		if (netif_is_bridge_master(lower_dev))
641 			continue;
642 
643 		/* When searching for switchdev interfaces that are neighbors
644 		 * of foreign ones, and @dev is a bridge, do not recurse on the
645 		 * foreign interface again, it was already visited.
646 		 */
647 		if (foreign_dev_check_cb && !check_cb(lower_dev) &&
648 		    !switchdev_lower_dev_find(lower_dev, check_cb, foreign_dev_check_cb))
649 			continue;
650 
651 		err = __switchdev_handle_port_obj_add(lower_dev, port_obj_info,
652 						      check_cb, foreign_dev_check_cb,
653 						      add_cb);
654 		if (err && err != -EOPNOTSUPP)
655 			return err;
656 	}
657 
658 	/* Event is neither on a bridge nor a LAG. Check whether it is on an
659 	 * interface that is in a bridge with us.
660 	 */
661 	if (!foreign_dev_check_cb)
662 		return err;
663 
664 	br = netdev_master_upper_dev_get(dev);
665 	if (!br || !netif_is_bridge_master(br))
666 		return err;
667 
668 	switchdev = switchdev_lower_dev_find(br, check_cb, foreign_dev_check_cb);
669 	if (!switchdev)
670 		return err;
671 
672 	if (!foreign_dev_check_cb(switchdev, dev))
673 		return err;
674 
675 	return __switchdev_handle_port_obj_add(br, port_obj_info, check_cb,
676 					       foreign_dev_check_cb, add_cb);
677 }
678 
679 /* Pass through a port object addition, if @dev passes @check_cb, or replicate
680  * it towards all lower interfaces of @dev that pass @check_cb, if @dev is a
681  * bridge or a LAG.
682  */
switchdev_handle_port_obj_add(struct net_device * dev,struct switchdev_notifier_port_obj_info * port_obj_info,bool (* check_cb)(const struct net_device * dev),int (* add_cb)(struct net_device * dev,const void * ctx,const struct switchdev_obj * obj,struct netlink_ext_ack * extack))683 int switchdev_handle_port_obj_add(struct net_device *dev,
684 			struct switchdev_notifier_port_obj_info *port_obj_info,
685 			bool (*check_cb)(const struct net_device *dev),
686 			int (*add_cb)(struct net_device *dev, const void *ctx,
687 				      const struct switchdev_obj *obj,
688 				      struct netlink_ext_ack *extack))
689 {
690 	int err;
691 
692 	err = __switchdev_handle_port_obj_add(dev, port_obj_info, check_cb,
693 					      NULL, add_cb);
694 	if (err == -EOPNOTSUPP)
695 		err = 0;
696 	return err;
697 }
698 EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_add);
699 
700 /* Same as switchdev_handle_port_obj_add(), except if object is notified on a
701  * @dev that passes @foreign_dev_check_cb, it is replicated towards all devices
702  * that pass @check_cb and are in the same bridge as @dev.
703  */
switchdev_handle_port_obj_add_foreign(struct net_device * dev,struct switchdev_notifier_port_obj_info * port_obj_info,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev),int (* add_cb)(struct net_device * dev,const void * ctx,const struct switchdev_obj * obj,struct netlink_ext_ack * extack))704 int switchdev_handle_port_obj_add_foreign(struct net_device *dev,
705 			struct switchdev_notifier_port_obj_info *port_obj_info,
706 			bool (*check_cb)(const struct net_device *dev),
707 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
708 						     const struct net_device *foreign_dev),
709 			int (*add_cb)(struct net_device *dev, const void *ctx,
710 				      const struct switchdev_obj *obj,
711 				      struct netlink_ext_ack *extack))
712 {
713 	int err;
714 
715 	err = __switchdev_handle_port_obj_add(dev, port_obj_info, check_cb,
716 					      foreign_dev_check_cb, add_cb);
717 	if (err == -EOPNOTSUPP)
718 		err = 0;
719 	return err;
720 }
721 EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_add_foreign);
722 
__switchdev_handle_port_obj_del(struct net_device * dev,struct switchdev_notifier_port_obj_info * port_obj_info,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev),int (* del_cb)(struct net_device * dev,const void * ctx,const struct switchdev_obj * obj))723 static int __switchdev_handle_port_obj_del(struct net_device *dev,
724 			struct switchdev_notifier_port_obj_info *port_obj_info,
725 			bool (*check_cb)(const struct net_device *dev),
726 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
727 						     const struct net_device *foreign_dev),
728 			int (*del_cb)(struct net_device *dev, const void *ctx,
729 				      const struct switchdev_obj *obj))
730 {
731 	struct switchdev_notifier_info *info = &port_obj_info->info;
732 	struct net_device *br, *lower_dev, *switchdev;
733 	struct list_head *iter;
734 	int err = -EOPNOTSUPP;
735 
736 	if (check_cb(dev)) {
737 		err = del_cb(dev, info->ctx, port_obj_info->obj);
738 		if (err != -EOPNOTSUPP)
739 			port_obj_info->handled = true;
740 		return err;
741 	}
742 
743 	/* Switch ports might be stacked under e.g. a LAG. Ignore the
744 	 * unsupported devices, another driver might be able to handle them. But
745 	 * propagate to the callers any hard errors.
746 	 *
747 	 * If the driver does its own bookkeeping of stacked ports, it's not
748 	 * necessary to go through this helper.
749 	 */
750 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
751 		if (netif_is_bridge_master(lower_dev))
752 			continue;
753 
754 		/* When searching for switchdev interfaces that are neighbors
755 		 * of foreign ones, and @dev is a bridge, do not recurse on the
756 		 * foreign interface again, it was already visited.
757 		 */
758 		if (foreign_dev_check_cb && !check_cb(lower_dev) &&
759 		    !switchdev_lower_dev_find(lower_dev, check_cb, foreign_dev_check_cb))
760 			continue;
761 
762 		err = __switchdev_handle_port_obj_del(lower_dev, port_obj_info,
763 						      check_cb, foreign_dev_check_cb,
764 						      del_cb);
765 		if (err && err != -EOPNOTSUPP)
766 			return err;
767 	}
768 
769 	/* Event is neither on a bridge nor a LAG. Check whether it is on an
770 	 * interface that is in a bridge with us.
771 	 */
772 	if (!foreign_dev_check_cb)
773 		return err;
774 
775 	br = netdev_master_upper_dev_get(dev);
776 	if (!br || !netif_is_bridge_master(br))
777 		return err;
778 
779 	switchdev = switchdev_lower_dev_find(br, check_cb, foreign_dev_check_cb);
780 	if (!switchdev)
781 		return err;
782 
783 	if (!foreign_dev_check_cb(switchdev, dev))
784 		return err;
785 
786 	return __switchdev_handle_port_obj_del(br, port_obj_info, check_cb,
787 					       foreign_dev_check_cb, del_cb);
788 }
789 
790 /* Pass through a port object deletion, if @dev passes @check_cb, or replicate
791  * it towards all lower interfaces of @dev that pass @check_cb, if @dev is a
792  * bridge or a LAG.
793  */
switchdev_handle_port_obj_del(struct net_device * dev,struct switchdev_notifier_port_obj_info * port_obj_info,bool (* check_cb)(const struct net_device * dev),int (* del_cb)(struct net_device * dev,const void * ctx,const struct switchdev_obj * obj))794 int switchdev_handle_port_obj_del(struct net_device *dev,
795 			struct switchdev_notifier_port_obj_info *port_obj_info,
796 			bool (*check_cb)(const struct net_device *dev),
797 			int (*del_cb)(struct net_device *dev, const void *ctx,
798 				      const struct switchdev_obj *obj))
799 {
800 	int err;
801 
802 	err = __switchdev_handle_port_obj_del(dev, port_obj_info, check_cb,
803 					      NULL, del_cb);
804 	if (err == -EOPNOTSUPP)
805 		err = 0;
806 	return err;
807 }
808 EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_del);
809 
810 /* Same as switchdev_handle_port_obj_del(), except if object is notified on a
811  * @dev that passes @foreign_dev_check_cb, it is replicated towards all devices
812  * that pass @check_cb and are in the same bridge as @dev.
813  */
switchdev_handle_port_obj_del_foreign(struct net_device * dev,struct switchdev_notifier_port_obj_info * port_obj_info,bool (* check_cb)(const struct net_device * dev),bool (* foreign_dev_check_cb)(const struct net_device * dev,const struct net_device * foreign_dev),int (* del_cb)(struct net_device * dev,const void * ctx,const struct switchdev_obj * obj))814 int switchdev_handle_port_obj_del_foreign(struct net_device *dev,
815 			struct switchdev_notifier_port_obj_info *port_obj_info,
816 			bool (*check_cb)(const struct net_device *dev),
817 			bool (*foreign_dev_check_cb)(const struct net_device *dev,
818 						     const struct net_device *foreign_dev),
819 			int (*del_cb)(struct net_device *dev, const void *ctx,
820 				      const struct switchdev_obj *obj))
821 {
822 	int err;
823 
824 	err = __switchdev_handle_port_obj_del(dev, port_obj_info, check_cb,
825 					      foreign_dev_check_cb, del_cb);
826 	if (err == -EOPNOTSUPP)
827 		err = 0;
828 	return err;
829 }
830 EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_del_foreign);
831 
__switchdev_handle_port_attr_set(struct net_device * dev,struct switchdev_notifier_port_attr_info * port_attr_info,bool (* check_cb)(const struct net_device * dev),int (* set_cb)(struct net_device * dev,const void * ctx,const struct switchdev_attr * attr,struct netlink_ext_ack * extack))832 static int __switchdev_handle_port_attr_set(struct net_device *dev,
833 			struct switchdev_notifier_port_attr_info *port_attr_info,
834 			bool (*check_cb)(const struct net_device *dev),
835 			int (*set_cb)(struct net_device *dev, const void *ctx,
836 				      const struct switchdev_attr *attr,
837 				      struct netlink_ext_ack *extack))
838 {
839 	struct switchdev_notifier_info *info = &port_attr_info->info;
840 	struct netlink_ext_ack *extack;
841 	struct net_device *lower_dev;
842 	struct list_head *iter;
843 	int err = -EOPNOTSUPP;
844 
845 	extack = switchdev_notifier_info_to_extack(info);
846 
847 	if (check_cb(dev)) {
848 		err = set_cb(dev, info->ctx, port_attr_info->attr, extack);
849 		if (err != -EOPNOTSUPP)
850 			port_attr_info->handled = true;
851 		return err;
852 	}
853 
854 	/* Switch ports might be stacked under e.g. a LAG. Ignore the
855 	 * unsupported devices, another driver might be able to handle them. But
856 	 * propagate to the callers any hard errors.
857 	 *
858 	 * If the driver does its own bookkeeping of stacked ports, it's not
859 	 * necessary to go through this helper.
860 	 */
861 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
862 		if (netif_is_bridge_master(lower_dev))
863 			continue;
864 
865 		err = __switchdev_handle_port_attr_set(lower_dev, port_attr_info,
866 						       check_cb, set_cb);
867 		if (err && err != -EOPNOTSUPP)
868 			return err;
869 	}
870 
871 	return err;
872 }
873 
switchdev_handle_port_attr_set(struct net_device * dev,struct switchdev_notifier_port_attr_info * port_attr_info,bool (* check_cb)(const struct net_device * dev),int (* set_cb)(struct net_device * dev,const void * ctx,const struct switchdev_attr * attr,struct netlink_ext_ack * extack))874 int switchdev_handle_port_attr_set(struct net_device *dev,
875 			struct switchdev_notifier_port_attr_info *port_attr_info,
876 			bool (*check_cb)(const struct net_device *dev),
877 			int (*set_cb)(struct net_device *dev, const void *ctx,
878 				      const struct switchdev_attr *attr,
879 				      struct netlink_ext_ack *extack))
880 {
881 	int err;
882 
883 	err = __switchdev_handle_port_attr_set(dev, port_attr_info, check_cb,
884 					       set_cb);
885 	if (err == -EOPNOTSUPP)
886 		err = 0;
887 	return err;
888 }
889 EXPORT_SYMBOL_GPL(switchdev_handle_port_attr_set);
890 
switchdev_bridge_port_offload(struct net_device * brport_dev,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)891 int switchdev_bridge_port_offload(struct net_device *brport_dev,
892 				  struct net_device *dev, const void *ctx,
893 				  struct notifier_block *atomic_nb,
894 				  struct notifier_block *blocking_nb,
895 				  bool tx_fwd_offload,
896 				  struct netlink_ext_ack *extack)
897 {
898 	struct switchdev_notifier_brport_info brport_info = {
899 		.brport = {
900 			.dev = dev,
901 			.ctx = ctx,
902 			.atomic_nb = atomic_nb,
903 			.blocking_nb = blocking_nb,
904 			.tx_fwd_offload = tx_fwd_offload,
905 		},
906 	};
907 	int err;
908 
909 	ASSERT_RTNL();
910 
911 	err = call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_OFFLOADED,
912 						brport_dev, &brport_info.info,
913 						extack);
914 	return notifier_to_errno(err);
915 }
916 EXPORT_SYMBOL_GPL(switchdev_bridge_port_offload);
917 
switchdev_bridge_port_unoffload(struct net_device * brport_dev,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb)918 void switchdev_bridge_port_unoffload(struct net_device *brport_dev,
919 				     const void *ctx,
920 				     struct notifier_block *atomic_nb,
921 				     struct notifier_block *blocking_nb)
922 {
923 	struct switchdev_notifier_brport_info brport_info = {
924 		.brport = {
925 			.ctx = ctx,
926 			.atomic_nb = atomic_nb,
927 			.blocking_nb = blocking_nb,
928 		},
929 	};
930 
931 	ASSERT_RTNL();
932 
933 	call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_UNOFFLOADED,
934 					  brport_dev, &brport_info.info,
935 					  NULL);
936 }
937 EXPORT_SYMBOL_GPL(switchdev_bridge_port_unoffload);
938 
switchdev_bridge_port_replay(struct net_device * brport_dev,struct net_device * dev,const void * ctx,struct notifier_block * atomic_nb,struct notifier_block * blocking_nb,struct netlink_ext_ack * extack)939 int switchdev_bridge_port_replay(struct net_device *brport_dev,
940 				 struct net_device *dev, const void *ctx,
941 				 struct notifier_block *atomic_nb,
942 				 struct notifier_block *blocking_nb,
943 				 struct netlink_ext_ack *extack)
944 {
945 	struct switchdev_notifier_brport_info brport_info = {
946 		.brport = {
947 			.dev = dev,
948 			.ctx = ctx,
949 			.atomic_nb = atomic_nb,
950 			.blocking_nb = blocking_nb,
951 		},
952 	};
953 	int err;
954 
955 	ASSERT_RTNL();
956 
957 	err = call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_REPLAY,
958 						brport_dev, &brport_info.info,
959 						extack);
960 	return notifier_to_errno(err);
961 }
962 EXPORT_SYMBOL_GPL(switchdev_bridge_port_replay);
963