xref: /linux-6.15/net/switchdev/switchdev.c (revision 3e3a78b4)
1007f790cSJiri Pirko /*
2007f790cSJiri Pirko  * net/switchdev/switchdev.c - Switch device API
3007f790cSJiri Pirko  * Copyright (c) 2014 Jiri Pirko <[email protected]>
4f8f21471SScott Feldman  * Copyright (c) 2014-2015 Scott Feldman <[email protected]>
5007f790cSJiri Pirko  *
6007f790cSJiri Pirko  * This program is free software; you can redistribute it and/or modify
7007f790cSJiri Pirko  * it under the terms of the GNU General Public License as published by
8007f790cSJiri Pirko  * the Free Software Foundation; either version 2 of the License, or
9007f790cSJiri Pirko  * (at your option) any later version.
10007f790cSJiri Pirko  */
11007f790cSJiri Pirko 
12007f790cSJiri Pirko #include <linux/kernel.h>
13007f790cSJiri Pirko #include <linux/types.h>
14007f790cSJiri Pirko #include <linux/init.h>
1503bf0c28SJiri Pirko #include <linux/mutex.h>
1603bf0c28SJiri Pirko #include <linux/notifier.h>
17007f790cSJiri Pirko #include <linux/netdevice.h>
1847f8328bSScott Feldman #include <linux/if_bridge.h>
195e8d9049SScott Feldman #include <net/ip_fib.h>
20007f790cSJiri Pirko #include <net/switchdev.h>
21007f790cSJiri Pirko 
22007f790cSJiri Pirko /**
233094333dSScott Feldman  *	switchdev_port_attr_get - Get port attribute
243094333dSScott Feldman  *
253094333dSScott Feldman  *	@dev: port device
263094333dSScott Feldman  *	@attr: attribute to get
273094333dSScott Feldman  */
283094333dSScott Feldman int switchdev_port_attr_get(struct net_device *dev, struct switchdev_attr *attr)
293094333dSScott Feldman {
303094333dSScott Feldman 	const struct switchdev_ops *ops = dev->switchdev_ops;
313094333dSScott Feldman 	struct net_device *lower_dev;
323094333dSScott Feldman 	struct list_head *iter;
333094333dSScott Feldman 	struct switchdev_attr first = {
343094333dSScott Feldman 		.id = SWITCHDEV_ATTR_UNDEFINED
353094333dSScott Feldman 	};
363094333dSScott Feldman 	int err = -EOPNOTSUPP;
373094333dSScott Feldman 
383094333dSScott Feldman 	if (ops && ops->switchdev_port_attr_get)
393094333dSScott Feldman 		return ops->switchdev_port_attr_get(dev, attr);
403094333dSScott Feldman 
413094333dSScott Feldman 	if (attr->flags & SWITCHDEV_F_NO_RECURSE)
423094333dSScott Feldman 		return err;
433094333dSScott Feldman 
443094333dSScott Feldman 	/* Switch device port(s) may be stacked under
453094333dSScott Feldman 	 * bond/team/vlan dev, so recurse down to get attr on
463094333dSScott Feldman 	 * each port.  Return -ENODATA if attr values don't
473094333dSScott Feldman 	 * compare across ports.
483094333dSScott Feldman 	 */
493094333dSScott Feldman 
503094333dSScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
513094333dSScott Feldman 		err = switchdev_port_attr_get(lower_dev, attr);
523094333dSScott Feldman 		if (err)
533094333dSScott Feldman 			break;
543094333dSScott Feldman 		if (first.id == SWITCHDEV_ATTR_UNDEFINED)
553094333dSScott Feldman 			first = *attr;
563094333dSScott Feldman 		else if (memcmp(&first, attr, sizeof(*attr)))
573094333dSScott Feldman 			return -ENODATA;
583094333dSScott Feldman 	}
593094333dSScott Feldman 
603094333dSScott Feldman 	return err;
613094333dSScott Feldman }
623094333dSScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_attr_get);
633094333dSScott Feldman 
643094333dSScott Feldman static int __switchdev_port_attr_set(struct net_device *dev,
653094333dSScott Feldman 				     struct switchdev_attr *attr)
663094333dSScott Feldman {
673094333dSScott Feldman 	const struct switchdev_ops *ops = dev->switchdev_ops;
683094333dSScott Feldman 	struct net_device *lower_dev;
693094333dSScott Feldman 	struct list_head *iter;
703094333dSScott Feldman 	int err = -EOPNOTSUPP;
713094333dSScott Feldman 
723094333dSScott Feldman 	if (ops && ops->switchdev_port_attr_set)
733094333dSScott Feldman 		return ops->switchdev_port_attr_set(dev, attr);
743094333dSScott Feldman 
753094333dSScott Feldman 	if (attr->flags & SWITCHDEV_F_NO_RECURSE)
763094333dSScott Feldman 		return err;
773094333dSScott Feldman 
783094333dSScott Feldman 	/* Switch device port(s) may be stacked under
793094333dSScott Feldman 	 * bond/team/vlan dev, so recurse down to set attr on
803094333dSScott Feldman 	 * each port.
813094333dSScott Feldman 	 */
823094333dSScott Feldman 
833094333dSScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
843094333dSScott Feldman 		err = __switchdev_port_attr_set(lower_dev, attr);
853094333dSScott Feldman 		if (err)
863094333dSScott Feldman 			break;
873094333dSScott Feldman 	}
883094333dSScott Feldman 
893094333dSScott Feldman 	return err;
903094333dSScott Feldman }
913094333dSScott Feldman 
923094333dSScott Feldman struct switchdev_attr_set_work {
933094333dSScott Feldman 	struct work_struct work;
943094333dSScott Feldman 	struct net_device *dev;
953094333dSScott Feldman 	struct switchdev_attr attr;
963094333dSScott Feldman };
973094333dSScott Feldman 
983094333dSScott Feldman static void switchdev_port_attr_set_work(struct work_struct *work)
993094333dSScott Feldman {
1003094333dSScott Feldman 	struct switchdev_attr_set_work *asw =
1013094333dSScott Feldman 		container_of(work, struct switchdev_attr_set_work, work);
1023094333dSScott Feldman 	int err;
1033094333dSScott Feldman 
1043094333dSScott Feldman 	rtnl_lock();
1053094333dSScott Feldman 	err = switchdev_port_attr_set(asw->dev, &asw->attr);
10657225e77SScott Feldman 	if (err && err != -EOPNOTSUPP)
10757225e77SScott Feldman 		netdev_err(asw->dev, "failed (err=%d) to set attribute (id=%d)\n",
10857225e77SScott Feldman 			   err, asw->attr.id);
1093094333dSScott Feldman 	rtnl_unlock();
1103094333dSScott Feldman 
1113094333dSScott Feldman 	dev_put(asw->dev);
1123094333dSScott Feldman 	kfree(work);
1133094333dSScott Feldman }
1143094333dSScott Feldman 
1153094333dSScott Feldman static int switchdev_port_attr_set_defer(struct net_device *dev,
1163094333dSScott Feldman 					 struct switchdev_attr *attr)
1173094333dSScott Feldman {
1183094333dSScott Feldman 	struct switchdev_attr_set_work *asw;
1193094333dSScott Feldman 
1203094333dSScott Feldman 	asw = kmalloc(sizeof(*asw), GFP_ATOMIC);
1213094333dSScott Feldman 	if (!asw)
1223094333dSScott Feldman 		return -ENOMEM;
1233094333dSScott Feldman 
1243094333dSScott Feldman 	INIT_WORK(&asw->work, switchdev_port_attr_set_work);
1253094333dSScott Feldman 
1263094333dSScott Feldman 	dev_hold(dev);
1273094333dSScott Feldman 	asw->dev = dev;
1283094333dSScott Feldman 	memcpy(&asw->attr, attr, sizeof(asw->attr));
1293094333dSScott Feldman 
1303094333dSScott Feldman 	schedule_work(&asw->work);
1313094333dSScott Feldman 
1323094333dSScott Feldman 	return 0;
1333094333dSScott Feldman }
1343094333dSScott Feldman 
1353094333dSScott Feldman /**
1363094333dSScott Feldman  *	switchdev_port_attr_set - Set port attribute
1373094333dSScott Feldman  *
1383094333dSScott Feldman  *	@dev: port device
1393094333dSScott Feldman  *	@attr: attribute to set
1403094333dSScott Feldman  *
1413094333dSScott Feldman  *	Use a 2-phase prepare-commit transaction model to ensure
1423094333dSScott Feldman  *	system is not left in a partially updated state due to
1433094333dSScott Feldman  *	failure from driver/device.
1443094333dSScott Feldman  */
1453094333dSScott Feldman int switchdev_port_attr_set(struct net_device *dev, struct switchdev_attr *attr)
1463094333dSScott Feldman {
1473094333dSScott Feldman 	int err;
1483094333dSScott Feldman 
1493094333dSScott Feldman 	if (!rtnl_is_locked()) {
1503094333dSScott Feldman 		/* Running prepare-commit transaction across stacked
1513094333dSScott Feldman 		 * devices requires nothing moves, so if rtnl_lock is
1523094333dSScott Feldman 		 * not held, schedule a worker thread to hold rtnl_lock
1533094333dSScott Feldman 		 * while setting attr.
1543094333dSScott Feldman 		 */
1553094333dSScott Feldman 
1563094333dSScott Feldman 		return switchdev_port_attr_set_defer(dev, attr);
1573094333dSScott Feldman 	}
1583094333dSScott Feldman 
1593094333dSScott Feldman 	/* Phase I: prepare for attr set. Driver/device should fail
1603094333dSScott Feldman 	 * here if there are going to be issues in the commit phase,
1613094333dSScott Feldman 	 * such as lack of resources or support.  The driver/device
1623094333dSScott Feldman 	 * should reserve resources needed for the commit phase here,
1633094333dSScott Feldman 	 * but should not commit the attr.
1643094333dSScott Feldman 	 */
1653094333dSScott Feldman 
1663094333dSScott Feldman 	attr->trans = SWITCHDEV_TRANS_PREPARE;
1673094333dSScott Feldman 	err = __switchdev_port_attr_set(dev, attr);
1683094333dSScott Feldman 	if (err) {
1693094333dSScott Feldman 		/* Prepare phase failed: abort the transaction.  Any
1703094333dSScott Feldman 		 * resources reserved in the prepare phase are
1713094333dSScott Feldman 		 * released.
1723094333dSScott Feldman 		 */
1733094333dSScott Feldman 
1743094333dSScott Feldman 		attr->trans = SWITCHDEV_TRANS_ABORT;
1753094333dSScott Feldman 		__switchdev_port_attr_set(dev, attr);
1763094333dSScott Feldman 
1773094333dSScott Feldman 		return err;
1783094333dSScott Feldman 	}
1793094333dSScott Feldman 
1803094333dSScott Feldman 	/* Phase II: commit attr set.  This cannot fail as a fault
1813094333dSScott Feldman 	 * of driver/device.  If it does, it's a bug in the driver/device
1823094333dSScott Feldman 	 * because the driver said everythings was OK in phase I.
1833094333dSScott Feldman 	 */
1843094333dSScott Feldman 
1853094333dSScott Feldman 	attr->trans = SWITCHDEV_TRANS_COMMIT;
1863094333dSScott Feldman 	err = __switchdev_port_attr_set(dev, attr);
1873094333dSScott Feldman 	BUG_ON(err);
1883094333dSScott Feldman 
1893094333dSScott Feldman 	return err;
1903094333dSScott Feldman }
1913094333dSScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_attr_set);
1923094333dSScott Feldman 
19322c1f67eSScott Feldman static int __switchdev_port_obj_add(struct net_device *dev,
19422c1f67eSScott Feldman 				    struct switchdev_obj *obj)
195491d0f15SScott Feldman {
196491d0f15SScott Feldman 	const struct switchdev_ops *ops = dev->switchdev_ops;
197491d0f15SScott Feldman 	struct net_device *lower_dev;
198491d0f15SScott Feldman 	struct list_head *iter;
199491d0f15SScott Feldman 	int err = -EOPNOTSUPP;
200491d0f15SScott Feldman 
201491d0f15SScott Feldman 	if (ops && ops->switchdev_port_obj_add)
202491d0f15SScott Feldman 		return ops->switchdev_port_obj_add(dev, obj);
203491d0f15SScott Feldman 
204491d0f15SScott Feldman 	/* Switch device port(s) may be stacked under
205491d0f15SScott Feldman 	 * bond/team/vlan dev, so recurse down to add object on
206491d0f15SScott Feldman 	 * each port.
207491d0f15SScott Feldman 	 */
208491d0f15SScott Feldman 
209491d0f15SScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
210491d0f15SScott Feldman 		err = __switchdev_port_obj_add(lower_dev, obj);
211491d0f15SScott Feldman 		if (err)
212491d0f15SScott Feldman 			break;
213491d0f15SScott Feldman 	}
214491d0f15SScott Feldman 
215491d0f15SScott Feldman 	return err;
216491d0f15SScott Feldman }
217491d0f15SScott Feldman 
218491d0f15SScott Feldman /**
219491d0f15SScott Feldman  *	switchdev_port_obj_add - Add port object
220491d0f15SScott Feldman  *
221491d0f15SScott Feldman  *	@dev: port device
222491d0f15SScott Feldman  *	@obj: object to add
223491d0f15SScott Feldman  *
224491d0f15SScott Feldman  *	Use a 2-phase prepare-commit transaction model to ensure
225491d0f15SScott Feldman  *	system is not left in a partially updated state due to
226491d0f15SScott Feldman  *	failure from driver/device.
227491d0f15SScott Feldman  *
228491d0f15SScott Feldman  *	rtnl_lock must be held.
229491d0f15SScott Feldman  */
230491d0f15SScott Feldman int switchdev_port_obj_add(struct net_device *dev, struct switchdev_obj *obj)
231491d0f15SScott Feldman {
232491d0f15SScott Feldman 	int err;
233491d0f15SScott Feldman 
234491d0f15SScott Feldman 	ASSERT_RTNL();
235491d0f15SScott Feldman 
236491d0f15SScott Feldman 	/* Phase I: prepare for obj add. Driver/device should fail
237491d0f15SScott Feldman 	 * here if there are going to be issues in the commit phase,
238491d0f15SScott Feldman 	 * such as lack of resources or support.  The driver/device
239491d0f15SScott Feldman 	 * should reserve resources needed for the commit phase here,
240491d0f15SScott Feldman 	 * but should not commit the obj.
241491d0f15SScott Feldman 	 */
242491d0f15SScott Feldman 
243491d0f15SScott Feldman 	obj->trans = SWITCHDEV_TRANS_PREPARE;
244491d0f15SScott Feldman 	err = __switchdev_port_obj_add(dev, obj);
245491d0f15SScott Feldman 	if (err) {
246491d0f15SScott Feldman 		/* Prepare phase failed: abort the transaction.  Any
247491d0f15SScott Feldman 		 * resources reserved in the prepare phase are
248491d0f15SScott Feldman 		 * released.
249491d0f15SScott Feldman 		 */
250491d0f15SScott Feldman 
251491d0f15SScott Feldman 		obj->trans = SWITCHDEV_TRANS_ABORT;
252491d0f15SScott Feldman 		__switchdev_port_obj_add(dev, obj);
253491d0f15SScott Feldman 
254491d0f15SScott Feldman 		return err;
255491d0f15SScott Feldman 	}
256491d0f15SScott Feldman 
257491d0f15SScott Feldman 	/* Phase II: commit obj add.  This cannot fail as a fault
258491d0f15SScott Feldman 	 * of driver/device.  If it does, it's a bug in the driver/device
259491d0f15SScott Feldman 	 * because the driver said everythings was OK in phase I.
260491d0f15SScott Feldman 	 */
261491d0f15SScott Feldman 
262491d0f15SScott Feldman 	obj->trans = SWITCHDEV_TRANS_COMMIT;
263491d0f15SScott Feldman 	err = __switchdev_port_obj_add(dev, obj);
264491d0f15SScott Feldman 	WARN(err, "%s: Commit of object (id=%d) failed.\n", dev->name, obj->id);
265491d0f15SScott Feldman 
266491d0f15SScott Feldman 	return err;
267491d0f15SScott Feldman }
268491d0f15SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_obj_add);
269491d0f15SScott Feldman 
270491d0f15SScott Feldman /**
271491d0f15SScott Feldman  *	switchdev_port_obj_del - Delete port object
272491d0f15SScott Feldman  *
273491d0f15SScott Feldman  *	@dev: port device
274491d0f15SScott Feldman  *	@obj: object to delete
275491d0f15SScott Feldman  */
276491d0f15SScott Feldman int switchdev_port_obj_del(struct net_device *dev, struct switchdev_obj *obj)
277491d0f15SScott Feldman {
278491d0f15SScott Feldman 	const struct switchdev_ops *ops = dev->switchdev_ops;
279491d0f15SScott Feldman 	struct net_device *lower_dev;
280491d0f15SScott Feldman 	struct list_head *iter;
281491d0f15SScott Feldman 	int err = -EOPNOTSUPP;
282491d0f15SScott Feldman 
283491d0f15SScott Feldman 	if (ops && ops->switchdev_port_obj_del)
284491d0f15SScott Feldman 		return ops->switchdev_port_obj_del(dev, obj);
285491d0f15SScott Feldman 
286491d0f15SScott Feldman 	/* Switch device port(s) may be stacked under
287491d0f15SScott Feldman 	 * bond/team/vlan dev, so recurse down to delete object on
288491d0f15SScott Feldman 	 * each port.
289491d0f15SScott Feldman 	 */
290491d0f15SScott Feldman 
291491d0f15SScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
292491d0f15SScott Feldman 		err = switchdev_port_obj_del(lower_dev, obj);
293491d0f15SScott Feldman 		if (err)
294491d0f15SScott Feldman 			break;
295491d0f15SScott Feldman 	}
296491d0f15SScott Feldman 
297491d0f15SScott Feldman 	return err;
298491d0f15SScott Feldman }
299491d0f15SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_obj_del);
300491d0f15SScott Feldman 
30145d4122cSSamudrala, Sridhar /**
30245d4122cSSamudrala, Sridhar  *	switchdev_port_obj_dump - Dump port objects
30345d4122cSSamudrala, Sridhar  *
30445d4122cSSamudrala, Sridhar  *	@dev: port device
30545d4122cSSamudrala, Sridhar  *	@obj: object to dump
30645d4122cSSamudrala, Sridhar  */
30745d4122cSSamudrala, Sridhar int switchdev_port_obj_dump(struct net_device *dev, struct switchdev_obj *obj)
30845d4122cSSamudrala, Sridhar {
30945d4122cSSamudrala, Sridhar 	const struct switchdev_ops *ops = dev->switchdev_ops;
31045d4122cSSamudrala, Sridhar 	struct net_device *lower_dev;
31145d4122cSSamudrala, Sridhar 	struct list_head *iter;
31245d4122cSSamudrala, Sridhar 	int err = -EOPNOTSUPP;
31345d4122cSSamudrala, Sridhar 
31445d4122cSSamudrala, Sridhar 	if (ops && ops->switchdev_port_obj_dump)
31545d4122cSSamudrala, Sridhar 		return ops->switchdev_port_obj_dump(dev, obj);
31645d4122cSSamudrala, Sridhar 
31745d4122cSSamudrala, Sridhar 	/* Switch device port(s) may be stacked under
31845d4122cSSamudrala, Sridhar 	 * bond/team/vlan dev, so recurse down to dump objects on
31945d4122cSSamudrala, Sridhar 	 * first port at bottom of stack.
32045d4122cSSamudrala, Sridhar 	 */
32145d4122cSSamudrala, Sridhar 
32245d4122cSSamudrala, Sridhar 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
32345d4122cSSamudrala, Sridhar 		err = switchdev_port_obj_dump(lower_dev, obj);
32445d4122cSSamudrala, Sridhar 		break;
32545d4122cSSamudrala, Sridhar 	}
32645d4122cSSamudrala, Sridhar 
32745d4122cSSamudrala, Sridhar 	return err;
32845d4122cSSamudrala, Sridhar }
32945d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_obj_dump);
33045d4122cSSamudrala, Sridhar 
331ebb9a03aSJiri Pirko static DEFINE_MUTEX(switchdev_mutex);
332ebb9a03aSJiri Pirko static RAW_NOTIFIER_HEAD(switchdev_notif_chain);
33303bf0c28SJiri Pirko 
33403bf0c28SJiri Pirko /**
335ebb9a03aSJiri Pirko  *	register_switchdev_notifier - Register notifier
33603bf0c28SJiri Pirko  *	@nb: notifier_block
33703bf0c28SJiri Pirko  *
33803bf0c28SJiri Pirko  *	Register switch device notifier. This should be used by code
33903bf0c28SJiri Pirko  *	which needs to monitor events happening in particular device.
34003bf0c28SJiri Pirko  *	Return values are same as for atomic_notifier_chain_register().
34103bf0c28SJiri Pirko  */
342ebb9a03aSJiri Pirko int register_switchdev_notifier(struct notifier_block *nb)
34303bf0c28SJiri Pirko {
34403bf0c28SJiri Pirko 	int err;
34503bf0c28SJiri Pirko 
346ebb9a03aSJiri Pirko 	mutex_lock(&switchdev_mutex);
347ebb9a03aSJiri Pirko 	err = raw_notifier_chain_register(&switchdev_notif_chain, nb);
348ebb9a03aSJiri Pirko 	mutex_unlock(&switchdev_mutex);
34903bf0c28SJiri Pirko 	return err;
35003bf0c28SJiri Pirko }
351ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(register_switchdev_notifier);
35203bf0c28SJiri Pirko 
35303bf0c28SJiri Pirko /**
354ebb9a03aSJiri Pirko  *	unregister_switchdev_notifier - Unregister notifier
35503bf0c28SJiri Pirko  *	@nb: notifier_block
35603bf0c28SJiri Pirko  *
35703bf0c28SJiri Pirko  *	Unregister switch device notifier.
35803bf0c28SJiri Pirko  *	Return values are same as for atomic_notifier_chain_unregister().
35903bf0c28SJiri Pirko  */
360ebb9a03aSJiri Pirko int unregister_switchdev_notifier(struct notifier_block *nb)
36103bf0c28SJiri Pirko {
36203bf0c28SJiri Pirko 	int err;
36303bf0c28SJiri Pirko 
364ebb9a03aSJiri Pirko 	mutex_lock(&switchdev_mutex);
365ebb9a03aSJiri Pirko 	err = raw_notifier_chain_unregister(&switchdev_notif_chain, nb);
366ebb9a03aSJiri Pirko 	mutex_unlock(&switchdev_mutex);
36703bf0c28SJiri Pirko 	return err;
36803bf0c28SJiri Pirko }
369ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(unregister_switchdev_notifier);
37003bf0c28SJiri Pirko 
37103bf0c28SJiri Pirko /**
372ebb9a03aSJiri Pirko  *	call_switchdev_notifiers - Call notifiers
37303bf0c28SJiri Pirko  *	@val: value passed unmodified to notifier function
37403bf0c28SJiri Pirko  *	@dev: port device
37503bf0c28SJiri Pirko  *	@info: notifier information data
37603bf0c28SJiri Pirko  *
37703bf0c28SJiri Pirko  *	Call all network notifier blocks. This should be called by driver
37803bf0c28SJiri Pirko  *	when it needs to propagate hardware event.
37903bf0c28SJiri Pirko  *	Return values are same as for atomic_notifier_call_chain().
38003bf0c28SJiri Pirko  */
381ebb9a03aSJiri Pirko int call_switchdev_notifiers(unsigned long val, struct net_device *dev,
382ebb9a03aSJiri Pirko 			     struct switchdev_notifier_info *info)
38303bf0c28SJiri Pirko {
38403bf0c28SJiri Pirko 	int err;
38503bf0c28SJiri Pirko 
38603bf0c28SJiri Pirko 	info->dev = dev;
387ebb9a03aSJiri Pirko 	mutex_lock(&switchdev_mutex);
388ebb9a03aSJiri Pirko 	err = raw_notifier_call_chain(&switchdev_notif_chain, val, info);
389ebb9a03aSJiri Pirko 	mutex_unlock(&switchdev_mutex);
39003bf0c28SJiri Pirko 	return err;
39103bf0c28SJiri Pirko }
392ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(call_switchdev_notifiers);
3938a44dbb2SRoopa Prabhu 
3948793d0a6SScott Feldman /**
3958793d0a6SScott Feldman  *	switchdev_port_bridge_getlink - Get bridge port attributes
3968793d0a6SScott Feldman  *
3978793d0a6SScott Feldman  *	@dev: port device
3988793d0a6SScott Feldman  *
3998793d0a6SScott Feldman  *	Called for SELF on rtnl_bridge_getlink to get bridge port
4008793d0a6SScott Feldman  *	attributes.
4018793d0a6SScott Feldman  */
4028793d0a6SScott Feldman int switchdev_port_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
4038793d0a6SScott Feldman 				  struct net_device *dev, u32 filter_mask,
4048793d0a6SScott Feldman 				  int nlflags)
4058793d0a6SScott Feldman {
4068793d0a6SScott Feldman 	struct switchdev_attr attr = {
4078793d0a6SScott Feldman 		.id = SWITCHDEV_ATTR_PORT_BRIDGE_FLAGS,
4088793d0a6SScott Feldman 	};
4098793d0a6SScott Feldman 	u16 mode = BRIDGE_MODE_UNDEF;
4108793d0a6SScott Feldman 	u32 mask = BR_LEARNING | BR_LEARNING_SYNC;
4118793d0a6SScott Feldman 	int err;
4128793d0a6SScott Feldman 
4138793d0a6SScott Feldman 	err = switchdev_port_attr_get(dev, &attr);
4148793d0a6SScott Feldman 	if (err)
4158793d0a6SScott Feldman 		return err;
4168793d0a6SScott Feldman 
4178793d0a6SScott Feldman 	return ndo_dflt_bridge_getlink(skb, pid, seq, dev, mode,
41842275bd8SScott Feldman 				       attr.u.brport_flags, mask, nlflags);
4198793d0a6SScott Feldman }
4208793d0a6SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_bridge_getlink);
4218793d0a6SScott Feldman 
42247f8328bSScott Feldman static int switchdev_port_br_setflag(struct net_device *dev,
42347f8328bSScott Feldman 				     struct nlattr *nlattr,
42447f8328bSScott Feldman 				     unsigned long brport_flag)
42547f8328bSScott Feldman {
42647f8328bSScott Feldman 	struct switchdev_attr attr = {
42747f8328bSScott Feldman 		.id = SWITCHDEV_ATTR_PORT_BRIDGE_FLAGS,
42847f8328bSScott Feldman 	};
42947f8328bSScott Feldman 	u8 flag = nla_get_u8(nlattr);
43047f8328bSScott Feldman 	int err;
43147f8328bSScott Feldman 
43247f8328bSScott Feldman 	err = switchdev_port_attr_get(dev, &attr);
43347f8328bSScott Feldman 	if (err)
43447f8328bSScott Feldman 		return err;
43547f8328bSScott Feldman 
43647f8328bSScott Feldman 	if (flag)
43742275bd8SScott Feldman 		attr.u.brport_flags |= brport_flag;
43847f8328bSScott Feldman 	else
43942275bd8SScott Feldman 		attr.u.brport_flags &= ~brport_flag;
44047f8328bSScott Feldman 
44147f8328bSScott Feldman 	return switchdev_port_attr_set(dev, &attr);
44247f8328bSScott Feldman }
44347f8328bSScott Feldman 
44447f8328bSScott Feldman static const struct nla_policy
44547f8328bSScott Feldman switchdev_port_bridge_policy[IFLA_BRPORT_MAX + 1] = {
44647f8328bSScott Feldman 	[IFLA_BRPORT_STATE]		= { .type = NLA_U8 },
44747f8328bSScott Feldman 	[IFLA_BRPORT_COST]		= { .type = NLA_U32 },
44847f8328bSScott Feldman 	[IFLA_BRPORT_PRIORITY]		= { .type = NLA_U16 },
44947f8328bSScott Feldman 	[IFLA_BRPORT_MODE]		= { .type = NLA_U8 },
45047f8328bSScott Feldman 	[IFLA_BRPORT_GUARD]		= { .type = NLA_U8 },
45147f8328bSScott Feldman 	[IFLA_BRPORT_PROTECT]		= { .type = NLA_U8 },
45247f8328bSScott Feldman 	[IFLA_BRPORT_FAST_LEAVE]	= { .type = NLA_U8 },
45347f8328bSScott Feldman 	[IFLA_BRPORT_LEARNING]		= { .type = NLA_U8 },
45447f8328bSScott Feldman 	[IFLA_BRPORT_LEARNING_SYNC]	= { .type = NLA_U8 },
45547f8328bSScott Feldman 	[IFLA_BRPORT_UNICAST_FLOOD]	= { .type = NLA_U8 },
45647f8328bSScott Feldman };
45747f8328bSScott Feldman 
45847f8328bSScott Feldman static int switchdev_port_br_setlink_protinfo(struct net_device *dev,
45947f8328bSScott Feldman 					      struct nlattr *protinfo)
46047f8328bSScott Feldman {
46147f8328bSScott Feldman 	struct nlattr *attr;
46247f8328bSScott Feldman 	int rem;
46347f8328bSScott Feldman 	int err;
46447f8328bSScott Feldman 
46547f8328bSScott Feldman 	err = nla_validate_nested(protinfo, IFLA_BRPORT_MAX,
46647f8328bSScott Feldman 				  switchdev_port_bridge_policy);
46747f8328bSScott Feldman 	if (err)
46847f8328bSScott Feldman 		return err;
46947f8328bSScott Feldman 
47047f8328bSScott Feldman 	nla_for_each_nested(attr, protinfo, rem) {
47147f8328bSScott Feldman 		switch (nla_type(attr)) {
47247f8328bSScott Feldman 		case IFLA_BRPORT_LEARNING:
47347f8328bSScott Feldman 			err = switchdev_port_br_setflag(dev, attr,
47447f8328bSScott Feldman 							BR_LEARNING);
47547f8328bSScott Feldman 			break;
47647f8328bSScott Feldman 		case IFLA_BRPORT_LEARNING_SYNC:
47747f8328bSScott Feldman 			err = switchdev_port_br_setflag(dev, attr,
47847f8328bSScott Feldman 							BR_LEARNING_SYNC);
47947f8328bSScott Feldman 			break;
48047f8328bSScott Feldman 		default:
48147f8328bSScott Feldman 			err = -EOPNOTSUPP;
48247f8328bSScott Feldman 			break;
48347f8328bSScott Feldman 		}
48447f8328bSScott Feldman 		if (err)
48547f8328bSScott Feldman 			return err;
48647f8328bSScott Feldman 	}
48747f8328bSScott Feldman 
48847f8328bSScott Feldman 	return 0;
48947f8328bSScott Feldman }
49047f8328bSScott Feldman 
49147f8328bSScott Feldman static int switchdev_port_br_afspec(struct net_device *dev,
49247f8328bSScott Feldman 				    struct nlattr *afspec,
49347f8328bSScott Feldman 				    int (*f)(struct net_device *dev,
49447f8328bSScott Feldman 					     struct switchdev_obj *obj))
49547f8328bSScott Feldman {
49647f8328bSScott Feldman 	struct nlattr *attr;
49747f8328bSScott Feldman 	struct bridge_vlan_info *vinfo;
49847f8328bSScott Feldman 	struct switchdev_obj obj = {
49947f8328bSScott Feldman 		.id = SWITCHDEV_OBJ_PORT_VLAN,
50047f8328bSScott Feldman 	};
50142275bd8SScott Feldman 	struct switchdev_obj_vlan *vlan = &obj.u.vlan;
50247f8328bSScott Feldman 	int rem;
50347f8328bSScott Feldman 	int err;
50447f8328bSScott Feldman 
50547f8328bSScott Feldman 	nla_for_each_nested(attr, afspec, rem) {
50647f8328bSScott Feldman 		if (nla_type(attr) != IFLA_BRIDGE_VLAN_INFO)
50747f8328bSScott Feldman 			continue;
50847f8328bSScott Feldman 		if (nla_len(attr) != sizeof(struct bridge_vlan_info))
50947f8328bSScott Feldman 			return -EINVAL;
51047f8328bSScott Feldman 		vinfo = nla_data(attr);
51142275bd8SScott Feldman 		vlan->flags = vinfo->flags;
51247f8328bSScott Feldman 		if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
513*3e3a78b4SScott Feldman 			if (vlan->vid_begin)
51447f8328bSScott Feldman 				return -EINVAL;
515*3e3a78b4SScott Feldman 			vlan->vid_begin = vinfo->vid;
51647f8328bSScott Feldman 		} else if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_END) {
517*3e3a78b4SScott Feldman 			if (!vlan->vid_begin)
51847f8328bSScott Feldman 				return -EINVAL;
51942275bd8SScott Feldman 			vlan->vid_end = vinfo->vid;
520*3e3a78b4SScott Feldman 			if (vlan->vid_end <= vlan->vid_begin)
52147f8328bSScott Feldman 				return -EINVAL;
52247f8328bSScott Feldman 			err = f(dev, &obj);
52347f8328bSScott Feldman 			if (err)
52447f8328bSScott Feldman 				return err;
52542275bd8SScott Feldman 			memset(vlan, 0, sizeof(*vlan));
52647f8328bSScott Feldman 		} else {
527*3e3a78b4SScott Feldman 			if (vlan->vid_begin)
52847f8328bSScott Feldman 				return -EINVAL;
529*3e3a78b4SScott Feldman 			vlan->vid_begin = vinfo->vid;
53042275bd8SScott Feldman 			vlan->vid_end = vinfo->vid;
53147f8328bSScott Feldman 			err = f(dev, &obj);
53247f8328bSScott Feldman 			if (err)
53347f8328bSScott Feldman 				return err;
53442275bd8SScott Feldman 			memset(vlan, 0, sizeof(*vlan));
53547f8328bSScott Feldman 		}
53647f8328bSScott Feldman 	}
53747f8328bSScott Feldman 
53847f8328bSScott Feldman 	return 0;
53947f8328bSScott Feldman }
54047f8328bSScott Feldman 
5418a44dbb2SRoopa Prabhu /**
54247f8328bSScott Feldman  *	switchdev_port_bridge_setlink - Set bridge port attributes
5438a44dbb2SRoopa Prabhu  *
5448a44dbb2SRoopa Prabhu  *	@dev: port device
54547f8328bSScott Feldman  *	@nlh: netlink header
54647f8328bSScott Feldman  *	@flags: netlink flags
5478a44dbb2SRoopa Prabhu  *
54847f8328bSScott Feldman  *	Called for SELF on rtnl_bridge_setlink to set bridge port
54947f8328bSScott Feldman  *	attributes.
5508a44dbb2SRoopa Prabhu  */
551ebb9a03aSJiri Pirko int switchdev_port_bridge_setlink(struct net_device *dev,
5528a44dbb2SRoopa Prabhu 				  struct nlmsghdr *nlh, u16 flags)
5538a44dbb2SRoopa Prabhu {
55447f8328bSScott Feldman 	struct nlattr *protinfo;
55547f8328bSScott Feldman 	struct nlattr *afspec;
55647f8328bSScott Feldman 	int err = 0;
5578a44dbb2SRoopa Prabhu 
55847f8328bSScott Feldman 	protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg),
55947f8328bSScott Feldman 				   IFLA_PROTINFO);
56047f8328bSScott Feldman 	if (protinfo) {
56147f8328bSScott Feldman 		err = switchdev_port_br_setlink_protinfo(dev, protinfo);
56247f8328bSScott Feldman 		if (err)
56347f8328bSScott Feldman 			return err;
56447f8328bSScott Feldman 	}
5658a44dbb2SRoopa Prabhu 
56647f8328bSScott Feldman 	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg),
56747f8328bSScott Feldman 				 IFLA_AF_SPEC);
56847f8328bSScott Feldman 	if (afspec)
56947f8328bSScott Feldman 		err = switchdev_port_br_afspec(dev, afspec,
57047f8328bSScott Feldman 					       switchdev_port_obj_add);
5718a44dbb2SRoopa Prabhu 
57247f8328bSScott Feldman 	return err;
5738a44dbb2SRoopa Prabhu }
574ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_port_bridge_setlink);
5758a44dbb2SRoopa Prabhu 
5768a44dbb2SRoopa Prabhu /**
5775c34e022SScott Feldman  *	switchdev_port_bridge_dellink - Set bridge port attributes
5788a44dbb2SRoopa Prabhu  *
5798a44dbb2SRoopa Prabhu  *	@dev: port device
5805c34e022SScott Feldman  *	@nlh: netlink header
5815c34e022SScott Feldman  *	@flags: netlink flags
5828a44dbb2SRoopa Prabhu  *
5835c34e022SScott Feldman  *	Called for SELF on rtnl_bridge_dellink to set bridge port
5845c34e022SScott Feldman  *	attributes.
5858a44dbb2SRoopa Prabhu  */
586ebb9a03aSJiri Pirko int switchdev_port_bridge_dellink(struct net_device *dev,
5878a44dbb2SRoopa Prabhu 				  struct nlmsghdr *nlh, u16 flags)
5888a44dbb2SRoopa Prabhu {
5895c34e022SScott Feldman 	struct nlattr *afspec;
5908a44dbb2SRoopa Prabhu 
5915c34e022SScott Feldman 	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg),
5925c34e022SScott Feldman 				 IFLA_AF_SPEC);
5935c34e022SScott Feldman 	if (afspec)
5945c34e022SScott Feldman 		return switchdev_port_br_afspec(dev, afspec,
5955c34e022SScott Feldman 						switchdev_port_obj_del);
5965c34e022SScott Feldman 
5978a44dbb2SRoopa Prabhu 	return 0;
5988a44dbb2SRoopa Prabhu }
599ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_port_bridge_dellink);
6008a44dbb2SRoopa Prabhu 
60145d4122cSSamudrala, Sridhar /**
60245d4122cSSamudrala, Sridhar  *	switchdev_port_fdb_add - Add FDB (MAC/VLAN) entry to port
60345d4122cSSamudrala, Sridhar  *
60445d4122cSSamudrala, Sridhar  *	@ndmsg: netlink hdr
60545d4122cSSamudrala, Sridhar  *	@nlattr: netlink attributes
60645d4122cSSamudrala, Sridhar  *	@dev: port device
60745d4122cSSamudrala, Sridhar  *	@addr: MAC address to add
60845d4122cSSamudrala, Sridhar  *	@vid: VLAN to add
60945d4122cSSamudrala, Sridhar  *
61045d4122cSSamudrala, Sridhar  *	Add FDB entry to switch device.
61145d4122cSSamudrala, Sridhar  */
61245d4122cSSamudrala, Sridhar int switchdev_port_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
61345d4122cSSamudrala, Sridhar 			   struct net_device *dev, const unsigned char *addr,
61445d4122cSSamudrala, Sridhar 			   u16 vid, u16 nlm_flags)
61545d4122cSSamudrala, Sridhar {
61645d4122cSSamudrala, Sridhar 	struct switchdev_obj obj = {
61745d4122cSSamudrala, Sridhar 		.id = SWITCHDEV_OBJ_PORT_FDB,
61845d4122cSSamudrala, Sridhar 		.u.fdb = {
61945d4122cSSamudrala, Sridhar 			.addr = addr,
62045d4122cSSamudrala, Sridhar 			.vid = vid,
62145d4122cSSamudrala, Sridhar 		},
62245d4122cSSamudrala, Sridhar 	};
62345d4122cSSamudrala, Sridhar 
62445d4122cSSamudrala, Sridhar 	return switchdev_port_obj_add(dev, &obj);
62545d4122cSSamudrala, Sridhar }
62645d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_fdb_add);
62745d4122cSSamudrala, Sridhar 
62845d4122cSSamudrala, Sridhar /**
62945d4122cSSamudrala, Sridhar  *	switchdev_port_fdb_del - Delete FDB (MAC/VLAN) entry from port
63045d4122cSSamudrala, Sridhar  *
63145d4122cSSamudrala, Sridhar  *	@ndmsg: netlink hdr
63245d4122cSSamudrala, Sridhar  *	@nlattr: netlink attributes
63345d4122cSSamudrala, Sridhar  *	@dev: port device
63445d4122cSSamudrala, Sridhar  *	@addr: MAC address to delete
63545d4122cSSamudrala, Sridhar  *	@vid: VLAN to delete
63645d4122cSSamudrala, Sridhar  *
63745d4122cSSamudrala, Sridhar  *	Delete FDB entry from switch device.
63845d4122cSSamudrala, Sridhar  */
63945d4122cSSamudrala, Sridhar int switchdev_port_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
64045d4122cSSamudrala, Sridhar 			   struct net_device *dev, const unsigned char *addr,
64145d4122cSSamudrala, Sridhar 			   u16 vid)
64245d4122cSSamudrala, Sridhar {
64345d4122cSSamudrala, Sridhar 	struct switchdev_obj obj = {
64445d4122cSSamudrala, Sridhar 		.id = SWITCHDEV_OBJ_PORT_FDB,
64545d4122cSSamudrala, Sridhar 		.u.fdb = {
64645d4122cSSamudrala, Sridhar 			.addr = addr,
64745d4122cSSamudrala, Sridhar 			.vid = vid,
64845d4122cSSamudrala, Sridhar 		},
64945d4122cSSamudrala, Sridhar 	};
65045d4122cSSamudrala, Sridhar 
65145d4122cSSamudrala, Sridhar 	return switchdev_port_obj_del(dev, &obj);
65245d4122cSSamudrala, Sridhar }
65345d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_fdb_del);
65445d4122cSSamudrala, Sridhar 
65545d4122cSSamudrala, Sridhar struct switchdev_fdb_dump {
65645d4122cSSamudrala, Sridhar 	struct switchdev_obj obj;
65745d4122cSSamudrala, Sridhar 	struct sk_buff *skb;
65845d4122cSSamudrala, Sridhar 	struct netlink_callback *cb;
65945d4122cSSamudrala, Sridhar 	int idx;
66045d4122cSSamudrala, Sridhar };
66145d4122cSSamudrala, Sridhar 
66245d4122cSSamudrala, Sridhar static int switchdev_port_fdb_dump_cb(struct net_device *dev,
66345d4122cSSamudrala, Sridhar 				      struct switchdev_obj *obj)
66445d4122cSSamudrala, Sridhar {
66545d4122cSSamudrala, Sridhar 	struct switchdev_fdb_dump *dump =
66645d4122cSSamudrala, Sridhar 		container_of(obj, struct switchdev_fdb_dump, obj);
66745d4122cSSamudrala, Sridhar 	u32 portid = NETLINK_CB(dump->cb->skb).portid;
66845d4122cSSamudrala, Sridhar 	u32 seq = dump->cb->nlh->nlmsg_seq;
66945d4122cSSamudrala, Sridhar 	struct nlmsghdr *nlh;
67045d4122cSSamudrala, Sridhar 	struct ndmsg *ndm;
67145d4122cSSamudrala, Sridhar 
67245d4122cSSamudrala, Sridhar 	if (dump->idx < dump->cb->args[0])
67345d4122cSSamudrala, Sridhar 		goto skip;
67445d4122cSSamudrala, Sridhar 
67545d4122cSSamudrala, Sridhar 	nlh = nlmsg_put(dump->skb, portid, seq, RTM_NEWNEIGH,
67645d4122cSSamudrala, Sridhar 			sizeof(*ndm), NLM_F_MULTI);
67745d4122cSSamudrala, Sridhar 	if (!nlh)
67845d4122cSSamudrala, Sridhar 		return -EMSGSIZE;
67945d4122cSSamudrala, Sridhar 
68045d4122cSSamudrala, Sridhar 	ndm = nlmsg_data(nlh);
68145d4122cSSamudrala, Sridhar 	ndm->ndm_family  = AF_BRIDGE;
68245d4122cSSamudrala, Sridhar 	ndm->ndm_pad1    = 0;
68345d4122cSSamudrala, Sridhar 	ndm->ndm_pad2    = 0;
68445d4122cSSamudrala, Sridhar 	ndm->ndm_flags   = NTF_SELF;
68545d4122cSSamudrala, Sridhar 	ndm->ndm_type    = 0;
68645d4122cSSamudrala, Sridhar 	ndm->ndm_ifindex = dev->ifindex;
68745d4122cSSamudrala, Sridhar 	ndm->ndm_state   = NUD_REACHABLE;
68845d4122cSSamudrala, Sridhar 
68945d4122cSSamudrala, Sridhar 	if (nla_put(dump->skb, NDA_LLADDR, ETH_ALEN, obj->u.fdb.addr))
69045d4122cSSamudrala, Sridhar 		goto nla_put_failure;
69145d4122cSSamudrala, Sridhar 
69245d4122cSSamudrala, Sridhar 	if (obj->u.fdb.vid && nla_put_u16(dump->skb, NDA_VLAN, obj->u.fdb.vid))
69345d4122cSSamudrala, Sridhar 		goto nla_put_failure;
69445d4122cSSamudrala, Sridhar 
69545d4122cSSamudrala, Sridhar 	nlmsg_end(dump->skb, nlh);
69645d4122cSSamudrala, Sridhar 
69745d4122cSSamudrala, Sridhar skip:
69845d4122cSSamudrala, Sridhar 	dump->idx++;
69945d4122cSSamudrala, Sridhar 	return 0;
70045d4122cSSamudrala, Sridhar 
70145d4122cSSamudrala, Sridhar nla_put_failure:
70245d4122cSSamudrala, Sridhar 	nlmsg_cancel(dump->skb, nlh);
70345d4122cSSamudrala, Sridhar 	return -EMSGSIZE;
70445d4122cSSamudrala, Sridhar }
70545d4122cSSamudrala, Sridhar 
70645d4122cSSamudrala, Sridhar /**
70745d4122cSSamudrala, Sridhar  *	switchdev_port_fdb_dump - Dump port FDB (MAC/VLAN) entries
70845d4122cSSamudrala, Sridhar  *
70945d4122cSSamudrala, Sridhar  *	@skb: netlink skb
71045d4122cSSamudrala, Sridhar  *	@cb: netlink callback
71145d4122cSSamudrala, Sridhar  *	@dev: port device
71245d4122cSSamudrala, Sridhar  *	@filter_dev: filter device
71345d4122cSSamudrala, Sridhar  *	@idx:
71445d4122cSSamudrala, Sridhar  *
71545d4122cSSamudrala, Sridhar  *	Delete FDB entry from switch device.
71645d4122cSSamudrala, Sridhar  */
71745d4122cSSamudrala, Sridhar int switchdev_port_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb,
71845d4122cSSamudrala, Sridhar 			    struct net_device *dev,
71945d4122cSSamudrala, Sridhar 			    struct net_device *filter_dev, int idx)
72045d4122cSSamudrala, Sridhar {
72145d4122cSSamudrala, Sridhar 	struct switchdev_fdb_dump dump = {
72245d4122cSSamudrala, Sridhar 		.obj = {
72345d4122cSSamudrala, Sridhar 			.id = SWITCHDEV_OBJ_PORT_FDB,
72445d4122cSSamudrala, Sridhar 			.cb = switchdev_port_fdb_dump_cb,
72545d4122cSSamudrala, Sridhar 		},
72645d4122cSSamudrala, Sridhar 		.skb = skb,
72745d4122cSSamudrala, Sridhar 		.cb = cb,
72845d4122cSSamudrala, Sridhar 		.idx = idx,
72945d4122cSSamudrala, Sridhar 	};
73045d4122cSSamudrala, Sridhar 	int err;
73145d4122cSSamudrala, Sridhar 
73245d4122cSSamudrala, Sridhar 	err = switchdev_port_obj_dump(dev, &dump.obj);
73345d4122cSSamudrala, Sridhar 	if (err)
73445d4122cSSamudrala, Sridhar 		return err;
73545d4122cSSamudrala, Sridhar 
73645d4122cSSamudrala, Sridhar 	return dump.idx;
73745d4122cSSamudrala, Sridhar }
73845d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_fdb_dump);
73945d4122cSSamudrala, Sridhar 
740ebb9a03aSJiri Pirko static struct net_device *switchdev_get_lowest_dev(struct net_device *dev)
741b5d6fbdeSScott Feldman {
7429d47c0a2SJiri Pirko 	const struct switchdev_ops *ops = dev->switchdev_ops;
743b5d6fbdeSScott Feldman 	struct net_device *lower_dev;
744b5d6fbdeSScott Feldman 	struct net_device *port_dev;
745b5d6fbdeSScott Feldman 	struct list_head *iter;
746b5d6fbdeSScott Feldman 
747b5d6fbdeSScott Feldman 	/* Recusively search down until we find a sw port dev.
748f8e20a9fSScott Feldman 	 * (A sw port dev supports switchdev_port_attr_get).
749b5d6fbdeSScott Feldman 	 */
750b5d6fbdeSScott Feldman 
751f8e20a9fSScott Feldman 	if (ops && ops->switchdev_port_attr_get)
752b5d6fbdeSScott Feldman 		return dev;
753b5d6fbdeSScott Feldman 
754b5d6fbdeSScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
755ebb9a03aSJiri Pirko 		port_dev = switchdev_get_lowest_dev(lower_dev);
756b5d6fbdeSScott Feldman 		if (port_dev)
757b5d6fbdeSScott Feldman 			return port_dev;
758b5d6fbdeSScott Feldman 	}
759b5d6fbdeSScott Feldman 
760b5d6fbdeSScott Feldman 	return NULL;
761b5d6fbdeSScott Feldman }
762b5d6fbdeSScott Feldman 
763ebb9a03aSJiri Pirko static struct net_device *switchdev_get_dev_by_nhs(struct fib_info *fi)
764b5d6fbdeSScott Feldman {
765f8e20a9fSScott Feldman 	struct switchdev_attr attr = {
766f8e20a9fSScott Feldman 		.id = SWITCHDEV_ATTR_PORT_PARENT_ID,
767f8e20a9fSScott Feldman 	};
768f8e20a9fSScott Feldman 	struct switchdev_attr prev_attr;
769b5d6fbdeSScott Feldman 	struct net_device *dev = NULL;
770b5d6fbdeSScott Feldman 	int nhsel;
771b5d6fbdeSScott Feldman 
772b5d6fbdeSScott Feldman 	/* For this route, all nexthop devs must be on the same switch. */
773b5d6fbdeSScott Feldman 
774b5d6fbdeSScott Feldman 	for (nhsel = 0; nhsel < fi->fib_nhs; nhsel++) {
775b5d6fbdeSScott Feldman 		const struct fib_nh *nh = &fi->fib_nh[nhsel];
776b5d6fbdeSScott Feldman 
777b5d6fbdeSScott Feldman 		if (!nh->nh_dev)
778b5d6fbdeSScott Feldman 			return NULL;
779b5d6fbdeSScott Feldman 
780ebb9a03aSJiri Pirko 		dev = switchdev_get_lowest_dev(nh->nh_dev);
781b5d6fbdeSScott Feldman 		if (!dev)
782b5d6fbdeSScott Feldman 			return NULL;
783b5d6fbdeSScott Feldman 
784f8e20a9fSScott Feldman 		if (switchdev_port_attr_get(dev, &attr))
785b5d6fbdeSScott Feldman 			return NULL;
786b5d6fbdeSScott Feldman 
787b5d6fbdeSScott Feldman 		if (nhsel > 0) {
78842275bd8SScott Feldman 			if (prev_attr.u.ppid.id_len != attr.u.ppid.id_len)
789b5d6fbdeSScott Feldman 				return NULL;
79042275bd8SScott Feldman 			if (memcmp(prev_attr.u.ppid.id, attr.u.ppid.id,
79142275bd8SScott Feldman 				   attr.u.ppid.id_len))
792b5d6fbdeSScott Feldman 				return NULL;
793b5d6fbdeSScott Feldman 		}
794b5d6fbdeSScott Feldman 
795f8e20a9fSScott Feldman 		prev_attr = attr;
796b5d6fbdeSScott Feldman 	}
797b5d6fbdeSScott Feldman 
798b5d6fbdeSScott Feldman 	return dev;
799b5d6fbdeSScott Feldman }
800b5d6fbdeSScott Feldman 
8015e8d9049SScott Feldman /**
8027616dcbbSScott Feldman  *	switchdev_fib_ipv4_add - Add/modify switch IPv4 route entry
8035e8d9049SScott Feldman  *
8045e8d9049SScott Feldman  *	@dst: route's IPv4 destination address
8055e8d9049SScott Feldman  *	@dst_len: destination address length (prefix length)
8065e8d9049SScott Feldman  *	@fi: route FIB info structure
8075e8d9049SScott Feldman  *	@tos: route TOS
8085e8d9049SScott Feldman  *	@type: route type
809f8f21471SScott Feldman  *	@nlflags: netlink flags passed in (NLM_F_*)
8105e8d9049SScott Feldman  *	@tb_id: route table ID
8115e8d9049SScott Feldman  *
8127616dcbbSScott Feldman  *	Add/modify switch IPv4 route entry.
8135e8d9049SScott Feldman  */
814ebb9a03aSJiri Pirko int switchdev_fib_ipv4_add(u32 dst, int dst_len, struct fib_info *fi,
815f8f21471SScott Feldman 			   u8 tos, u8 type, u32 nlflags, u32 tb_id)
8165e8d9049SScott Feldman {
81758c2cb16SScott Feldman 	struct switchdev_obj fib_obj = {
81858c2cb16SScott Feldman 		.id = SWITCHDEV_OBJ_IPV4_FIB,
81942275bd8SScott Feldman 		.u.ipv4_fib = {
8207a7ee531SScott Feldman 			.dst = dst,
82158c2cb16SScott Feldman 			.dst_len = dst_len,
82258c2cb16SScott Feldman 			.fi = fi,
82358c2cb16SScott Feldman 			.tos = tos,
82458c2cb16SScott Feldman 			.type = type,
82558c2cb16SScott Feldman 			.nlflags = nlflags,
82658c2cb16SScott Feldman 			.tb_id = tb_id,
82758c2cb16SScott Feldman 		},
82858c2cb16SScott Feldman 	};
829b5d6fbdeSScott Feldman 	struct net_device *dev;
830b5d6fbdeSScott Feldman 	int err = 0;
831b5d6fbdeSScott Feldman 
8328e05fd71SScott Feldman 	/* Don't offload route if using custom ip rules or if
8338e05fd71SScott Feldman 	 * IPv4 FIB offloading has been disabled completely.
8348e05fd71SScott Feldman 	 */
8358e05fd71SScott Feldman 
836e1315db1SScott Feldman #ifdef CONFIG_IP_MULTIPLE_TABLES
837e1315db1SScott Feldman 	if (fi->fib_net->ipv4.fib_has_custom_rules)
838e1315db1SScott Feldman 		return 0;
839e1315db1SScott Feldman #endif
840e1315db1SScott Feldman 
841e1315db1SScott Feldman 	if (fi->fib_net->ipv4.fib_offload_disabled)
842104616e7SScott Feldman 		return 0;
843104616e7SScott Feldman 
844ebb9a03aSJiri Pirko 	dev = switchdev_get_dev_by_nhs(fi);
845b5d6fbdeSScott Feldman 	if (!dev)
8465e8d9049SScott Feldman 		return 0;
847b5d6fbdeSScott Feldman 
84858c2cb16SScott Feldman 	err = switchdev_port_obj_add(dev, &fib_obj);
849b5d6fbdeSScott Feldman 	if (!err)
850eea39946SRoopa Prabhu 		fi->fib_flags |= RTNH_F_OFFLOAD;
851b5d6fbdeSScott Feldman 
852af201f72SScott Feldman 	return err == -EOPNOTSUPP ? 0 : err;
8535e8d9049SScott Feldman }
854ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_fib_ipv4_add);
8555e8d9049SScott Feldman 
8565e8d9049SScott Feldman /**
857ebb9a03aSJiri Pirko  *	switchdev_fib_ipv4_del - Delete IPv4 route entry from switch
8585e8d9049SScott Feldman  *
8595e8d9049SScott Feldman  *	@dst: route's IPv4 destination address
8605e8d9049SScott Feldman  *	@dst_len: destination address length (prefix length)
8615e8d9049SScott Feldman  *	@fi: route FIB info structure
8625e8d9049SScott Feldman  *	@tos: route TOS
8635e8d9049SScott Feldman  *	@type: route type
8645e8d9049SScott Feldman  *	@tb_id: route table ID
8655e8d9049SScott Feldman  *
8665e8d9049SScott Feldman  *	Delete IPv4 route entry from switch device.
8675e8d9049SScott Feldman  */
868ebb9a03aSJiri Pirko int switchdev_fib_ipv4_del(u32 dst, int dst_len, struct fib_info *fi,
8695e8d9049SScott Feldman 			   u8 tos, u8 type, u32 tb_id)
8705e8d9049SScott Feldman {
87158c2cb16SScott Feldman 	struct switchdev_obj fib_obj = {
87258c2cb16SScott Feldman 		.id = SWITCHDEV_OBJ_IPV4_FIB,
87342275bd8SScott Feldman 		.u.ipv4_fib = {
8747a7ee531SScott Feldman 			.dst = dst,
87558c2cb16SScott Feldman 			.dst_len = dst_len,
87658c2cb16SScott Feldman 			.fi = fi,
87758c2cb16SScott Feldman 			.tos = tos,
87858c2cb16SScott Feldman 			.type = type,
87958c2cb16SScott Feldman 			.nlflags = 0,
88058c2cb16SScott Feldman 			.tb_id = tb_id,
88158c2cb16SScott Feldman 		},
88258c2cb16SScott Feldman 	};
883b5d6fbdeSScott Feldman 	struct net_device *dev;
884b5d6fbdeSScott Feldman 	int err = 0;
885b5d6fbdeSScott Feldman 
886eea39946SRoopa Prabhu 	if (!(fi->fib_flags & RTNH_F_OFFLOAD))
8875e8d9049SScott Feldman 		return 0;
888b5d6fbdeSScott Feldman 
889ebb9a03aSJiri Pirko 	dev = switchdev_get_dev_by_nhs(fi);
890b5d6fbdeSScott Feldman 	if (!dev)
891b5d6fbdeSScott Feldman 		return 0;
892b5d6fbdeSScott Feldman 
89358c2cb16SScott Feldman 	err = switchdev_port_obj_del(dev, &fib_obj);
894b5d6fbdeSScott Feldman 	if (!err)
895eea39946SRoopa Prabhu 		fi->fib_flags &= ~RTNH_F_OFFLOAD;
896b5d6fbdeSScott Feldman 
897af201f72SScott Feldman 	return err == -EOPNOTSUPP ? 0 : err;
8985e8d9049SScott Feldman }
899ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_fib_ipv4_del);
9008e05fd71SScott Feldman 
9018e05fd71SScott Feldman /**
902ebb9a03aSJiri Pirko  *	switchdev_fib_ipv4_abort - Abort an IPv4 FIB operation
9038e05fd71SScott Feldman  *
9048e05fd71SScott Feldman  *	@fi: route FIB info structure
9058e05fd71SScott Feldman  */
906ebb9a03aSJiri Pirko void switchdev_fib_ipv4_abort(struct fib_info *fi)
9078e05fd71SScott Feldman {
9088e05fd71SScott Feldman 	/* There was a problem installing this route to the offload
9098e05fd71SScott Feldman 	 * device.  For now, until we come up with more refined
9108e05fd71SScott Feldman 	 * policy handling, abruptly end IPv4 fib offloading for
9118e05fd71SScott Feldman 	 * for entire net by flushing offload device(s) of all
9128e05fd71SScott Feldman 	 * IPv4 routes, and mark IPv4 fib offloading broken from
9138e05fd71SScott Feldman 	 * this point forward.
9148e05fd71SScott Feldman 	 */
9158e05fd71SScott Feldman 
9168e05fd71SScott Feldman 	fib_flush_external(fi->fib_net);
9178e05fd71SScott Feldman 	fi->fib_net->ipv4.fib_offload_disabled = true;
9188e05fd71SScott Feldman }
919ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_fib_ipv4_abort);
920