xref: /linux-6.15/net/switchdev/switchdev.c (revision 7616dcbb)
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);
1063094333dSScott Feldman 	BUG_ON(err);
1073094333dSScott Feldman 	rtnl_unlock();
1083094333dSScott Feldman 
1093094333dSScott Feldman 	dev_put(asw->dev);
1103094333dSScott Feldman 	kfree(work);
1113094333dSScott Feldman }
1123094333dSScott Feldman 
1133094333dSScott Feldman static int switchdev_port_attr_set_defer(struct net_device *dev,
1143094333dSScott Feldman 					 struct switchdev_attr *attr)
1153094333dSScott Feldman {
1163094333dSScott Feldman 	struct switchdev_attr_set_work *asw;
1173094333dSScott Feldman 
1183094333dSScott Feldman 	asw = kmalloc(sizeof(*asw), GFP_ATOMIC);
1193094333dSScott Feldman 	if (!asw)
1203094333dSScott Feldman 		return -ENOMEM;
1213094333dSScott Feldman 
1223094333dSScott Feldman 	INIT_WORK(&asw->work, switchdev_port_attr_set_work);
1233094333dSScott Feldman 
1243094333dSScott Feldman 	dev_hold(dev);
1253094333dSScott Feldman 	asw->dev = dev;
1263094333dSScott Feldman 	memcpy(&asw->attr, attr, sizeof(asw->attr));
1273094333dSScott Feldman 
1283094333dSScott Feldman 	schedule_work(&asw->work);
1293094333dSScott Feldman 
1303094333dSScott Feldman 	return 0;
1313094333dSScott Feldman }
1323094333dSScott Feldman 
1333094333dSScott Feldman /**
1343094333dSScott Feldman  *	switchdev_port_attr_set - Set port attribute
1353094333dSScott Feldman  *
1363094333dSScott Feldman  *	@dev: port device
1373094333dSScott Feldman  *	@attr: attribute to set
1383094333dSScott Feldman  *
1393094333dSScott Feldman  *	Use a 2-phase prepare-commit transaction model to ensure
1403094333dSScott Feldman  *	system is not left in a partially updated state due to
1413094333dSScott Feldman  *	failure from driver/device.
1423094333dSScott Feldman  */
1433094333dSScott Feldman int switchdev_port_attr_set(struct net_device *dev, struct switchdev_attr *attr)
1443094333dSScott Feldman {
1453094333dSScott Feldman 	int err;
1463094333dSScott Feldman 
1473094333dSScott Feldman 	if (!rtnl_is_locked()) {
1483094333dSScott Feldman 		/* Running prepare-commit transaction across stacked
1493094333dSScott Feldman 		 * devices requires nothing moves, so if rtnl_lock is
1503094333dSScott Feldman 		 * not held, schedule a worker thread to hold rtnl_lock
1513094333dSScott Feldman 		 * while setting attr.
1523094333dSScott Feldman 		 */
1533094333dSScott Feldman 
1543094333dSScott Feldman 		return switchdev_port_attr_set_defer(dev, attr);
1553094333dSScott Feldman 	}
1563094333dSScott Feldman 
1573094333dSScott Feldman 	/* Phase I: prepare for attr set. Driver/device should fail
1583094333dSScott Feldman 	 * here if there are going to be issues in the commit phase,
1593094333dSScott Feldman 	 * such as lack of resources or support.  The driver/device
1603094333dSScott Feldman 	 * should reserve resources needed for the commit phase here,
1613094333dSScott Feldman 	 * but should not commit the attr.
1623094333dSScott Feldman 	 */
1633094333dSScott Feldman 
1643094333dSScott Feldman 	attr->trans = SWITCHDEV_TRANS_PREPARE;
1653094333dSScott Feldman 	err = __switchdev_port_attr_set(dev, attr);
1663094333dSScott Feldman 	if (err) {
1673094333dSScott Feldman 		/* Prepare phase failed: abort the transaction.  Any
1683094333dSScott Feldman 		 * resources reserved in the prepare phase are
1693094333dSScott Feldman 		 * released.
1703094333dSScott Feldman 		 */
1713094333dSScott Feldman 
1723094333dSScott Feldman 		attr->trans = SWITCHDEV_TRANS_ABORT;
1733094333dSScott Feldman 		__switchdev_port_attr_set(dev, attr);
1743094333dSScott Feldman 
1753094333dSScott Feldman 		return err;
1763094333dSScott Feldman 	}
1773094333dSScott Feldman 
1783094333dSScott Feldman 	/* Phase II: commit attr set.  This cannot fail as a fault
1793094333dSScott Feldman 	 * of driver/device.  If it does, it's a bug in the driver/device
1803094333dSScott Feldman 	 * because the driver said everythings was OK in phase I.
1813094333dSScott Feldman 	 */
1823094333dSScott Feldman 
1833094333dSScott Feldman 	attr->trans = SWITCHDEV_TRANS_COMMIT;
1843094333dSScott Feldman 	err = __switchdev_port_attr_set(dev, attr);
1853094333dSScott Feldman 	BUG_ON(err);
1863094333dSScott Feldman 
1873094333dSScott Feldman 	return err;
1883094333dSScott Feldman }
1893094333dSScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_attr_set);
1903094333dSScott Feldman 
19122c1f67eSScott Feldman static int __switchdev_port_obj_add(struct net_device *dev,
19222c1f67eSScott Feldman 				    struct switchdev_obj *obj)
193491d0f15SScott Feldman {
194491d0f15SScott Feldman 	const struct switchdev_ops *ops = dev->switchdev_ops;
195491d0f15SScott Feldman 	struct net_device *lower_dev;
196491d0f15SScott Feldman 	struct list_head *iter;
197491d0f15SScott Feldman 	int err = -EOPNOTSUPP;
198491d0f15SScott Feldman 
199491d0f15SScott Feldman 	if (ops && ops->switchdev_port_obj_add)
200491d0f15SScott Feldman 		return ops->switchdev_port_obj_add(dev, obj);
201491d0f15SScott Feldman 
202491d0f15SScott Feldman 	/* Switch device port(s) may be stacked under
203491d0f15SScott Feldman 	 * bond/team/vlan dev, so recurse down to add object on
204491d0f15SScott Feldman 	 * each port.
205491d0f15SScott Feldman 	 */
206491d0f15SScott Feldman 
207491d0f15SScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
208491d0f15SScott Feldman 		err = __switchdev_port_obj_add(lower_dev, obj);
209491d0f15SScott Feldman 		if (err)
210491d0f15SScott Feldman 			break;
211491d0f15SScott Feldman 	}
212491d0f15SScott Feldman 
213491d0f15SScott Feldman 	return err;
214491d0f15SScott Feldman }
215491d0f15SScott Feldman 
216491d0f15SScott Feldman /**
217491d0f15SScott Feldman  *	switchdev_port_obj_add - Add port object
218491d0f15SScott Feldman  *
219491d0f15SScott Feldman  *	@dev: port device
220491d0f15SScott Feldman  *	@obj: object to add
221491d0f15SScott Feldman  *
222491d0f15SScott Feldman  *	Use a 2-phase prepare-commit transaction model to ensure
223491d0f15SScott Feldman  *	system is not left in a partially updated state due to
224491d0f15SScott Feldman  *	failure from driver/device.
225491d0f15SScott Feldman  *
226491d0f15SScott Feldman  *	rtnl_lock must be held.
227491d0f15SScott Feldman  */
228491d0f15SScott Feldman int switchdev_port_obj_add(struct net_device *dev, struct switchdev_obj *obj)
229491d0f15SScott Feldman {
230491d0f15SScott Feldman 	int err;
231491d0f15SScott Feldman 
232491d0f15SScott Feldman 	ASSERT_RTNL();
233491d0f15SScott Feldman 
234491d0f15SScott Feldman 	/* Phase I: prepare for obj add. Driver/device should fail
235491d0f15SScott Feldman 	 * here if there are going to be issues in the commit phase,
236491d0f15SScott Feldman 	 * such as lack of resources or support.  The driver/device
237491d0f15SScott Feldman 	 * should reserve resources needed for the commit phase here,
238491d0f15SScott Feldman 	 * but should not commit the obj.
239491d0f15SScott Feldman 	 */
240491d0f15SScott Feldman 
241491d0f15SScott Feldman 	obj->trans = SWITCHDEV_TRANS_PREPARE;
242491d0f15SScott Feldman 	err = __switchdev_port_obj_add(dev, obj);
243491d0f15SScott Feldman 	if (err) {
244491d0f15SScott Feldman 		/* Prepare phase failed: abort the transaction.  Any
245491d0f15SScott Feldman 		 * resources reserved in the prepare phase are
246491d0f15SScott Feldman 		 * released.
247491d0f15SScott Feldman 		 */
248491d0f15SScott Feldman 
249491d0f15SScott Feldman 		obj->trans = SWITCHDEV_TRANS_ABORT;
250491d0f15SScott Feldman 		__switchdev_port_obj_add(dev, obj);
251491d0f15SScott Feldman 
252491d0f15SScott Feldman 		return err;
253491d0f15SScott Feldman 	}
254491d0f15SScott Feldman 
255491d0f15SScott Feldman 	/* Phase II: commit obj add.  This cannot fail as a fault
256491d0f15SScott Feldman 	 * of driver/device.  If it does, it's a bug in the driver/device
257491d0f15SScott Feldman 	 * because the driver said everythings was OK in phase I.
258491d0f15SScott Feldman 	 */
259491d0f15SScott Feldman 
260491d0f15SScott Feldman 	obj->trans = SWITCHDEV_TRANS_COMMIT;
261491d0f15SScott Feldman 	err = __switchdev_port_obj_add(dev, obj);
262491d0f15SScott Feldman 	WARN(err, "%s: Commit of object (id=%d) failed.\n", dev->name, obj->id);
263491d0f15SScott Feldman 
264491d0f15SScott Feldman 	return err;
265491d0f15SScott Feldman }
266491d0f15SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_obj_add);
267491d0f15SScott Feldman 
268491d0f15SScott Feldman /**
269491d0f15SScott Feldman  *	switchdev_port_obj_del - Delete port object
270491d0f15SScott Feldman  *
271491d0f15SScott Feldman  *	@dev: port device
272491d0f15SScott Feldman  *	@obj: object to delete
273491d0f15SScott Feldman  */
274491d0f15SScott Feldman int switchdev_port_obj_del(struct net_device *dev, struct switchdev_obj *obj)
275491d0f15SScott Feldman {
276491d0f15SScott Feldman 	const struct switchdev_ops *ops = dev->switchdev_ops;
277491d0f15SScott Feldman 	struct net_device *lower_dev;
278491d0f15SScott Feldman 	struct list_head *iter;
279491d0f15SScott Feldman 	int err = -EOPNOTSUPP;
280491d0f15SScott Feldman 
281491d0f15SScott Feldman 	if (ops && ops->switchdev_port_obj_del)
282491d0f15SScott Feldman 		return ops->switchdev_port_obj_del(dev, obj);
283491d0f15SScott Feldman 
284491d0f15SScott Feldman 	/* Switch device port(s) may be stacked under
285491d0f15SScott Feldman 	 * bond/team/vlan dev, so recurse down to delete object on
286491d0f15SScott Feldman 	 * each port.
287491d0f15SScott Feldman 	 */
288491d0f15SScott Feldman 
289491d0f15SScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
290491d0f15SScott Feldman 		err = switchdev_port_obj_del(lower_dev, obj);
291491d0f15SScott Feldman 		if (err)
292491d0f15SScott Feldman 			break;
293491d0f15SScott Feldman 	}
294491d0f15SScott Feldman 
295491d0f15SScott Feldman 	return err;
296491d0f15SScott Feldman }
297491d0f15SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_obj_del);
298491d0f15SScott Feldman 
29945d4122cSSamudrala, Sridhar /**
30045d4122cSSamudrala, Sridhar  *	switchdev_port_obj_dump - Dump port objects
30145d4122cSSamudrala, Sridhar  *
30245d4122cSSamudrala, Sridhar  *	@dev: port device
30345d4122cSSamudrala, Sridhar  *	@obj: object to dump
30445d4122cSSamudrala, Sridhar  */
30545d4122cSSamudrala, Sridhar int switchdev_port_obj_dump(struct net_device *dev, struct switchdev_obj *obj)
30645d4122cSSamudrala, Sridhar {
30745d4122cSSamudrala, Sridhar 	const struct switchdev_ops *ops = dev->switchdev_ops;
30845d4122cSSamudrala, Sridhar 	struct net_device *lower_dev;
30945d4122cSSamudrala, Sridhar 	struct list_head *iter;
31045d4122cSSamudrala, Sridhar 	int err = -EOPNOTSUPP;
31145d4122cSSamudrala, Sridhar 
31245d4122cSSamudrala, Sridhar 	if (ops && ops->switchdev_port_obj_dump)
31345d4122cSSamudrala, Sridhar 		return ops->switchdev_port_obj_dump(dev, obj);
31445d4122cSSamudrala, Sridhar 
31545d4122cSSamudrala, Sridhar 	/* Switch device port(s) may be stacked under
31645d4122cSSamudrala, Sridhar 	 * bond/team/vlan dev, so recurse down to dump objects on
31745d4122cSSamudrala, Sridhar 	 * first port at bottom of stack.
31845d4122cSSamudrala, Sridhar 	 */
31945d4122cSSamudrala, Sridhar 
32045d4122cSSamudrala, Sridhar 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
32145d4122cSSamudrala, Sridhar 		err = switchdev_port_obj_dump(lower_dev, obj);
32245d4122cSSamudrala, Sridhar 		break;
32345d4122cSSamudrala, Sridhar 	}
32445d4122cSSamudrala, Sridhar 
32545d4122cSSamudrala, Sridhar 	return err;
32645d4122cSSamudrala, Sridhar }
32745d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_obj_dump);
32845d4122cSSamudrala, Sridhar 
329ebb9a03aSJiri Pirko static DEFINE_MUTEX(switchdev_mutex);
330ebb9a03aSJiri Pirko static RAW_NOTIFIER_HEAD(switchdev_notif_chain);
33103bf0c28SJiri Pirko 
33203bf0c28SJiri Pirko /**
333ebb9a03aSJiri Pirko  *	register_switchdev_notifier - Register notifier
33403bf0c28SJiri Pirko  *	@nb: notifier_block
33503bf0c28SJiri Pirko  *
33603bf0c28SJiri Pirko  *	Register switch device notifier. This should be used by code
33703bf0c28SJiri Pirko  *	which needs to monitor events happening in particular device.
33803bf0c28SJiri Pirko  *	Return values are same as for atomic_notifier_chain_register().
33903bf0c28SJiri Pirko  */
340ebb9a03aSJiri Pirko int register_switchdev_notifier(struct notifier_block *nb)
34103bf0c28SJiri Pirko {
34203bf0c28SJiri Pirko 	int err;
34303bf0c28SJiri Pirko 
344ebb9a03aSJiri Pirko 	mutex_lock(&switchdev_mutex);
345ebb9a03aSJiri Pirko 	err = raw_notifier_chain_register(&switchdev_notif_chain, nb);
346ebb9a03aSJiri Pirko 	mutex_unlock(&switchdev_mutex);
34703bf0c28SJiri Pirko 	return err;
34803bf0c28SJiri Pirko }
349ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(register_switchdev_notifier);
35003bf0c28SJiri Pirko 
35103bf0c28SJiri Pirko /**
352ebb9a03aSJiri Pirko  *	unregister_switchdev_notifier - Unregister notifier
35303bf0c28SJiri Pirko  *	@nb: notifier_block
35403bf0c28SJiri Pirko  *
35503bf0c28SJiri Pirko  *	Unregister switch device notifier.
35603bf0c28SJiri Pirko  *	Return values are same as for atomic_notifier_chain_unregister().
35703bf0c28SJiri Pirko  */
358ebb9a03aSJiri Pirko int unregister_switchdev_notifier(struct notifier_block *nb)
35903bf0c28SJiri Pirko {
36003bf0c28SJiri Pirko 	int err;
36103bf0c28SJiri Pirko 
362ebb9a03aSJiri Pirko 	mutex_lock(&switchdev_mutex);
363ebb9a03aSJiri Pirko 	err = raw_notifier_chain_unregister(&switchdev_notif_chain, nb);
364ebb9a03aSJiri Pirko 	mutex_unlock(&switchdev_mutex);
36503bf0c28SJiri Pirko 	return err;
36603bf0c28SJiri Pirko }
367ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(unregister_switchdev_notifier);
36803bf0c28SJiri Pirko 
36903bf0c28SJiri Pirko /**
370ebb9a03aSJiri Pirko  *	call_switchdev_notifiers - Call notifiers
37103bf0c28SJiri Pirko  *	@val: value passed unmodified to notifier function
37203bf0c28SJiri Pirko  *	@dev: port device
37303bf0c28SJiri Pirko  *	@info: notifier information data
37403bf0c28SJiri Pirko  *
37503bf0c28SJiri Pirko  *	Call all network notifier blocks. This should be called by driver
37603bf0c28SJiri Pirko  *	when it needs to propagate hardware event.
37703bf0c28SJiri Pirko  *	Return values are same as for atomic_notifier_call_chain().
37803bf0c28SJiri Pirko  */
379ebb9a03aSJiri Pirko int call_switchdev_notifiers(unsigned long val, struct net_device *dev,
380ebb9a03aSJiri Pirko 			     struct switchdev_notifier_info *info)
38103bf0c28SJiri Pirko {
38203bf0c28SJiri Pirko 	int err;
38303bf0c28SJiri Pirko 
38403bf0c28SJiri Pirko 	info->dev = dev;
385ebb9a03aSJiri Pirko 	mutex_lock(&switchdev_mutex);
386ebb9a03aSJiri Pirko 	err = raw_notifier_call_chain(&switchdev_notif_chain, val, info);
387ebb9a03aSJiri Pirko 	mutex_unlock(&switchdev_mutex);
38803bf0c28SJiri Pirko 	return err;
38903bf0c28SJiri Pirko }
390ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(call_switchdev_notifiers);
3918a44dbb2SRoopa Prabhu 
3928793d0a6SScott Feldman /**
3938793d0a6SScott Feldman  *	switchdev_port_bridge_getlink - Get bridge port attributes
3948793d0a6SScott Feldman  *
3958793d0a6SScott Feldman  *	@dev: port device
3968793d0a6SScott Feldman  *
3978793d0a6SScott Feldman  *	Called for SELF on rtnl_bridge_getlink to get bridge port
3988793d0a6SScott Feldman  *	attributes.
3998793d0a6SScott Feldman  */
4008793d0a6SScott Feldman int switchdev_port_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq,
4018793d0a6SScott Feldman 				  struct net_device *dev, u32 filter_mask,
4028793d0a6SScott Feldman 				  int nlflags)
4038793d0a6SScott Feldman {
4048793d0a6SScott Feldman 	struct switchdev_attr attr = {
4058793d0a6SScott Feldman 		.id = SWITCHDEV_ATTR_PORT_BRIDGE_FLAGS,
4068793d0a6SScott Feldman 	};
4078793d0a6SScott Feldman 	u16 mode = BRIDGE_MODE_UNDEF;
4088793d0a6SScott Feldman 	u32 mask = BR_LEARNING | BR_LEARNING_SYNC;
4098793d0a6SScott Feldman 	int err;
4108793d0a6SScott Feldman 
4118793d0a6SScott Feldman 	err = switchdev_port_attr_get(dev, &attr);
4128793d0a6SScott Feldman 	if (err)
4138793d0a6SScott Feldman 		return err;
4148793d0a6SScott Feldman 
4158793d0a6SScott Feldman 	return ndo_dflt_bridge_getlink(skb, pid, seq, dev, mode,
41642275bd8SScott Feldman 				       attr.u.brport_flags, mask, nlflags);
4178793d0a6SScott Feldman }
4188793d0a6SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_bridge_getlink);
4198793d0a6SScott Feldman 
42047f8328bSScott Feldman static int switchdev_port_br_setflag(struct net_device *dev,
42147f8328bSScott Feldman 				     struct nlattr *nlattr,
42247f8328bSScott Feldman 				     unsigned long brport_flag)
42347f8328bSScott Feldman {
42447f8328bSScott Feldman 	struct switchdev_attr attr = {
42547f8328bSScott Feldman 		.id = SWITCHDEV_ATTR_PORT_BRIDGE_FLAGS,
42647f8328bSScott Feldman 	};
42747f8328bSScott Feldman 	u8 flag = nla_get_u8(nlattr);
42847f8328bSScott Feldman 	int err;
42947f8328bSScott Feldman 
43047f8328bSScott Feldman 	err = switchdev_port_attr_get(dev, &attr);
43147f8328bSScott Feldman 	if (err)
43247f8328bSScott Feldman 		return err;
43347f8328bSScott Feldman 
43447f8328bSScott Feldman 	if (flag)
43542275bd8SScott Feldman 		attr.u.brport_flags |= brport_flag;
43647f8328bSScott Feldman 	else
43742275bd8SScott Feldman 		attr.u.brport_flags &= ~brport_flag;
43847f8328bSScott Feldman 
43947f8328bSScott Feldman 	return switchdev_port_attr_set(dev, &attr);
44047f8328bSScott Feldman }
44147f8328bSScott Feldman 
44247f8328bSScott Feldman static const struct nla_policy
44347f8328bSScott Feldman switchdev_port_bridge_policy[IFLA_BRPORT_MAX + 1] = {
44447f8328bSScott Feldman 	[IFLA_BRPORT_STATE]		= { .type = NLA_U8 },
44547f8328bSScott Feldman 	[IFLA_BRPORT_COST]		= { .type = NLA_U32 },
44647f8328bSScott Feldman 	[IFLA_BRPORT_PRIORITY]		= { .type = NLA_U16 },
44747f8328bSScott Feldman 	[IFLA_BRPORT_MODE]		= { .type = NLA_U8 },
44847f8328bSScott Feldman 	[IFLA_BRPORT_GUARD]		= { .type = NLA_U8 },
44947f8328bSScott Feldman 	[IFLA_BRPORT_PROTECT]		= { .type = NLA_U8 },
45047f8328bSScott Feldman 	[IFLA_BRPORT_FAST_LEAVE]	= { .type = NLA_U8 },
45147f8328bSScott Feldman 	[IFLA_BRPORT_LEARNING]		= { .type = NLA_U8 },
45247f8328bSScott Feldman 	[IFLA_BRPORT_LEARNING_SYNC]	= { .type = NLA_U8 },
45347f8328bSScott Feldman 	[IFLA_BRPORT_UNICAST_FLOOD]	= { .type = NLA_U8 },
45447f8328bSScott Feldman };
45547f8328bSScott Feldman 
45647f8328bSScott Feldman static int switchdev_port_br_setlink_protinfo(struct net_device *dev,
45747f8328bSScott Feldman 					      struct nlattr *protinfo)
45847f8328bSScott Feldman {
45947f8328bSScott Feldman 	struct nlattr *attr;
46047f8328bSScott Feldman 	int rem;
46147f8328bSScott Feldman 	int err;
46247f8328bSScott Feldman 
46347f8328bSScott Feldman 	err = nla_validate_nested(protinfo, IFLA_BRPORT_MAX,
46447f8328bSScott Feldman 				  switchdev_port_bridge_policy);
46547f8328bSScott Feldman 	if (err)
46647f8328bSScott Feldman 		return err;
46747f8328bSScott Feldman 
46847f8328bSScott Feldman 	nla_for_each_nested(attr, protinfo, rem) {
46947f8328bSScott Feldman 		switch (nla_type(attr)) {
47047f8328bSScott Feldman 		case IFLA_BRPORT_LEARNING:
47147f8328bSScott Feldman 			err = switchdev_port_br_setflag(dev, attr,
47247f8328bSScott Feldman 							BR_LEARNING);
47347f8328bSScott Feldman 			break;
47447f8328bSScott Feldman 		case IFLA_BRPORT_LEARNING_SYNC:
47547f8328bSScott Feldman 			err = switchdev_port_br_setflag(dev, attr,
47647f8328bSScott Feldman 							BR_LEARNING_SYNC);
47747f8328bSScott Feldman 			break;
47847f8328bSScott Feldman 		default:
47947f8328bSScott Feldman 			err = -EOPNOTSUPP;
48047f8328bSScott Feldman 			break;
48147f8328bSScott Feldman 		}
48247f8328bSScott Feldman 		if (err)
48347f8328bSScott Feldman 			return err;
48447f8328bSScott Feldman 	}
48547f8328bSScott Feldman 
48647f8328bSScott Feldman 	return 0;
48747f8328bSScott Feldman }
48847f8328bSScott Feldman 
48947f8328bSScott Feldman static int switchdev_port_br_afspec(struct net_device *dev,
49047f8328bSScott Feldman 				    struct nlattr *afspec,
49147f8328bSScott Feldman 				    int (*f)(struct net_device *dev,
49247f8328bSScott Feldman 					     struct switchdev_obj *obj))
49347f8328bSScott Feldman {
49447f8328bSScott Feldman 	struct nlattr *attr;
49547f8328bSScott Feldman 	struct bridge_vlan_info *vinfo;
49647f8328bSScott Feldman 	struct switchdev_obj obj = {
49747f8328bSScott Feldman 		.id = SWITCHDEV_OBJ_PORT_VLAN,
49847f8328bSScott Feldman 	};
49942275bd8SScott Feldman 	struct switchdev_obj_vlan *vlan = &obj.u.vlan;
50047f8328bSScott Feldman 	int rem;
50147f8328bSScott Feldman 	int err;
50247f8328bSScott Feldman 
50347f8328bSScott Feldman 	nla_for_each_nested(attr, afspec, rem) {
50447f8328bSScott Feldman 		if (nla_type(attr) != IFLA_BRIDGE_VLAN_INFO)
50547f8328bSScott Feldman 			continue;
50647f8328bSScott Feldman 		if (nla_len(attr) != sizeof(struct bridge_vlan_info))
50747f8328bSScott Feldman 			return -EINVAL;
50847f8328bSScott Feldman 		vinfo = nla_data(attr);
50942275bd8SScott Feldman 		vlan->flags = vinfo->flags;
51047f8328bSScott Feldman 		if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
51142275bd8SScott Feldman 			if (vlan->vid_start)
51247f8328bSScott Feldman 				return -EINVAL;
51342275bd8SScott Feldman 			vlan->vid_start = vinfo->vid;
51447f8328bSScott Feldman 		} else if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_END) {
51542275bd8SScott Feldman 			if (!vlan->vid_start)
51647f8328bSScott Feldman 				return -EINVAL;
51742275bd8SScott Feldman 			vlan->vid_end = vinfo->vid;
51842275bd8SScott Feldman 			if (vlan->vid_end <= vlan->vid_start)
51947f8328bSScott Feldman 				return -EINVAL;
52047f8328bSScott Feldman 			err = f(dev, &obj);
52147f8328bSScott Feldman 			if (err)
52247f8328bSScott Feldman 				return err;
52342275bd8SScott Feldman 			memset(vlan, 0, sizeof(*vlan));
52447f8328bSScott Feldman 		} else {
52542275bd8SScott Feldman 			if (vlan->vid_start)
52647f8328bSScott Feldman 				return -EINVAL;
52742275bd8SScott Feldman 			vlan->vid_start = vinfo->vid;
52842275bd8SScott Feldman 			vlan->vid_end = vinfo->vid;
52947f8328bSScott Feldman 			err = f(dev, &obj);
53047f8328bSScott Feldman 			if (err)
53147f8328bSScott Feldman 				return err;
53242275bd8SScott Feldman 			memset(vlan, 0, sizeof(*vlan));
53347f8328bSScott Feldman 		}
53447f8328bSScott Feldman 	}
53547f8328bSScott Feldman 
53647f8328bSScott Feldman 	return 0;
53747f8328bSScott Feldman }
53847f8328bSScott Feldman 
5398a44dbb2SRoopa Prabhu /**
54047f8328bSScott Feldman  *	switchdev_port_bridge_setlink - Set bridge port attributes
5418a44dbb2SRoopa Prabhu  *
5428a44dbb2SRoopa Prabhu  *	@dev: port device
54347f8328bSScott Feldman  *	@nlh: netlink header
54447f8328bSScott Feldman  *	@flags: netlink flags
5458a44dbb2SRoopa Prabhu  *
54647f8328bSScott Feldman  *	Called for SELF on rtnl_bridge_setlink to set bridge port
54747f8328bSScott Feldman  *	attributes.
5488a44dbb2SRoopa Prabhu  */
549ebb9a03aSJiri Pirko int switchdev_port_bridge_setlink(struct net_device *dev,
5508a44dbb2SRoopa Prabhu 				  struct nlmsghdr *nlh, u16 flags)
5518a44dbb2SRoopa Prabhu {
55247f8328bSScott Feldman 	struct nlattr *protinfo;
55347f8328bSScott Feldman 	struct nlattr *afspec;
55447f8328bSScott Feldman 	int err = 0;
5558a44dbb2SRoopa Prabhu 
55647f8328bSScott Feldman 	protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg),
55747f8328bSScott Feldman 				   IFLA_PROTINFO);
55847f8328bSScott Feldman 	if (protinfo) {
55947f8328bSScott Feldman 		err = switchdev_port_br_setlink_protinfo(dev, protinfo);
56047f8328bSScott Feldman 		if (err)
56147f8328bSScott Feldman 			return err;
56247f8328bSScott Feldman 	}
5638a44dbb2SRoopa Prabhu 
56447f8328bSScott Feldman 	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg),
56547f8328bSScott Feldman 				 IFLA_AF_SPEC);
56647f8328bSScott Feldman 	if (afspec)
56747f8328bSScott Feldman 		err = switchdev_port_br_afspec(dev, afspec,
56847f8328bSScott Feldman 					       switchdev_port_obj_add);
5698a44dbb2SRoopa Prabhu 
57047f8328bSScott Feldman 	return err;
5718a44dbb2SRoopa Prabhu }
572ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_port_bridge_setlink);
5738a44dbb2SRoopa Prabhu 
5748a44dbb2SRoopa Prabhu /**
5755c34e022SScott Feldman  *	switchdev_port_bridge_dellink - Set bridge port attributes
5768a44dbb2SRoopa Prabhu  *
5778a44dbb2SRoopa Prabhu  *	@dev: port device
5785c34e022SScott Feldman  *	@nlh: netlink header
5795c34e022SScott Feldman  *	@flags: netlink flags
5808a44dbb2SRoopa Prabhu  *
5815c34e022SScott Feldman  *	Called for SELF on rtnl_bridge_dellink to set bridge port
5825c34e022SScott Feldman  *	attributes.
5838a44dbb2SRoopa Prabhu  */
584ebb9a03aSJiri Pirko int switchdev_port_bridge_dellink(struct net_device *dev,
5858a44dbb2SRoopa Prabhu 				  struct nlmsghdr *nlh, u16 flags)
5868a44dbb2SRoopa Prabhu {
5875c34e022SScott Feldman 	struct nlattr *afspec;
5888a44dbb2SRoopa Prabhu 
5895c34e022SScott Feldman 	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg),
5905c34e022SScott Feldman 				 IFLA_AF_SPEC);
5915c34e022SScott Feldman 	if (afspec)
5925c34e022SScott Feldman 		return switchdev_port_br_afspec(dev, afspec,
5935c34e022SScott Feldman 						switchdev_port_obj_del);
5945c34e022SScott Feldman 
5958a44dbb2SRoopa Prabhu 	return 0;
5968a44dbb2SRoopa Prabhu }
597ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_port_bridge_dellink);
5988a44dbb2SRoopa Prabhu 
59945d4122cSSamudrala, Sridhar /**
60045d4122cSSamudrala, Sridhar  *	switchdev_port_fdb_add - Add FDB (MAC/VLAN) entry to port
60145d4122cSSamudrala, Sridhar  *
60245d4122cSSamudrala, Sridhar  *	@ndmsg: netlink hdr
60345d4122cSSamudrala, Sridhar  *	@nlattr: netlink attributes
60445d4122cSSamudrala, Sridhar  *	@dev: port device
60545d4122cSSamudrala, Sridhar  *	@addr: MAC address to add
60645d4122cSSamudrala, Sridhar  *	@vid: VLAN to add
60745d4122cSSamudrala, Sridhar  *
60845d4122cSSamudrala, Sridhar  *	Add FDB entry to switch device.
60945d4122cSSamudrala, Sridhar  */
61045d4122cSSamudrala, Sridhar int switchdev_port_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
61145d4122cSSamudrala, Sridhar 			   struct net_device *dev, const unsigned char *addr,
61245d4122cSSamudrala, Sridhar 			   u16 vid, u16 nlm_flags)
61345d4122cSSamudrala, Sridhar {
61445d4122cSSamudrala, Sridhar 	struct switchdev_obj obj = {
61545d4122cSSamudrala, Sridhar 		.id = SWITCHDEV_OBJ_PORT_FDB,
61645d4122cSSamudrala, Sridhar 		.u.fdb = {
61745d4122cSSamudrala, Sridhar 			.addr = addr,
61845d4122cSSamudrala, Sridhar 			.vid = vid,
61945d4122cSSamudrala, Sridhar 		},
62045d4122cSSamudrala, Sridhar 	};
62145d4122cSSamudrala, Sridhar 
62245d4122cSSamudrala, Sridhar 	return switchdev_port_obj_add(dev, &obj);
62345d4122cSSamudrala, Sridhar }
62445d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_fdb_add);
62545d4122cSSamudrala, Sridhar 
62645d4122cSSamudrala, Sridhar /**
62745d4122cSSamudrala, Sridhar  *	switchdev_port_fdb_del - Delete FDB (MAC/VLAN) entry from port
62845d4122cSSamudrala, Sridhar  *
62945d4122cSSamudrala, Sridhar  *	@ndmsg: netlink hdr
63045d4122cSSamudrala, Sridhar  *	@nlattr: netlink attributes
63145d4122cSSamudrala, Sridhar  *	@dev: port device
63245d4122cSSamudrala, Sridhar  *	@addr: MAC address to delete
63345d4122cSSamudrala, Sridhar  *	@vid: VLAN to delete
63445d4122cSSamudrala, Sridhar  *
63545d4122cSSamudrala, Sridhar  *	Delete FDB entry from switch device.
63645d4122cSSamudrala, Sridhar  */
63745d4122cSSamudrala, Sridhar int switchdev_port_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
63845d4122cSSamudrala, Sridhar 			   struct net_device *dev, const unsigned char *addr,
63945d4122cSSamudrala, Sridhar 			   u16 vid)
64045d4122cSSamudrala, Sridhar {
64145d4122cSSamudrala, Sridhar 	struct switchdev_obj obj = {
64245d4122cSSamudrala, Sridhar 		.id = SWITCHDEV_OBJ_PORT_FDB,
64345d4122cSSamudrala, Sridhar 		.u.fdb = {
64445d4122cSSamudrala, Sridhar 			.addr = addr,
64545d4122cSSamudrala, Sridhar 			.vid = vid,
64645d4122cSSamudrala, Sridhar 		},
64745d4122cSSamudrala, Sridhar 	};
64845d4122cSSamudrala, Sridhar 
64945d4122cSSamudrala, Sridhar 	return switchdev_port_obj_del(dev, &obj);
65045d4122cSSamudrala, Sridhar }
65145d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_fdb_del);
65245d4122cSSamudrala, Sridhar 
65345d4122cSSamudrala, Sridhar struct switchdev_fdb_dump {
65445d4122cSSamudrala, Sridhar 	struct switchdev_obj obj;
65545d4122cSSamudrala, Sridhar 	struct sk_buff *skb;
65645d4122cSSamudrala, Sridhar 	struct netlink_callback *cb;
65745d4122cSSamudrala, Sridhar 	struct net_device *filter_dev;
65845d4122cSSamudrala, Sridhar 	int idx;
65945d4122cSSamudrala, Sridhar };
66045d4122cSSamudrala, Sridhar 
66145d4122cSSamudrala, Sridhar static int switchdev_port_fdb_dump_cb(struct net_device *dev,
66245d4122cSSamudrala, Sridhar 				      struct switchdev_obj *obj)
66345d4122cSSamudrala, Sridhar {
66445d4122cSSamudrala, Sridhar 	struct switchdev_fdb_dump *dump =
66545d4122cSSamudrala, Sridhar 		container_of(obj, struct switchdev_fdb_dump, obj);
66645d4122cSSamudrala, Sridhar 	u32 portid = NETLINK_CB(dump->cb->skb).portid;
66745d4122cSSamudrala, Sridhar 	u32 seq = dump->cb->nlh->nlmsg_seq;
66845d4122cSSamudrala, Sridhar 	struct nlmsghdr *nlh;
66945d4122cSSamudrala, Sridhar 	struct ndmsg *ndm;
67045d4122cSSamudrala, Sridhar 	struct net_device *master = netdev_master_upper_dev_get(dev);
67145d4122cSSamudrala, Sridhar 
67245d4122cSSamudrala, Sridhar 	if (dump->idx < dump->cb->args[0])
67345d4122cSSamudrala, Sridhar 		goto skip;
67445d4122cSSamudrala, Sridhar 
67545d4122cSSamudrala, Sridhar 	if (master && dump->filter_dev != master)
67645d4122cSSamudrala, Sridhar 		goto skip;
67745d4122cSSamudrala, Sridhar 
67845d4122cSSamudrala, Sridhar 	nlh = nlmsg_put(dump->skb, portid, seq, RTM_NEWNEIGH,
67945d4122cSSamudrala, Sridhar 			sizeof(*ndm), NLM_F_MULTI);
68045d4122cSSamudrala, Sridhar 	if (!nlh)
68145d4122cSSamudrala, Sridhar 		return -EMSGSIZE;
68245d4122cSSamudrala, Sridhar 
68345d4122cSSamudrala, Sridhar 	ndm = nlmsg_data(nlh);
68445d4122cSSamudrala, Sridhar 	ndm->ndm_family  = AF_BRIDGE;
68545d4122cSSamudrala, Sridhar 	ndm->ndm_pad1    = 0;
68645d4122cSSamudrala, Sridhar 	ndm->ndm_pad2    = 0;
68745d4122cSSamudrala, Sridhar 	ndm->ndm_flags   = NTF_SELF;
68845d4122cSSamudrala, Sridhar 	ndm->ndm_type    = 0;
68945d4122cSSamudrala, Sridhar 	ndm->ndm_ifindex = dev->ifindex;
69045d4122cSSamudrala, Sridhar 	ndm->ndm_state   = NUD_REACHABLE;
69145d4122cSSamudrala, Sridhar 
69245d4122cSSamudrala, Sridhar 	if (nla_put(dump->skb, NDA_LLADDR, ETH_ALEN, obj->u.fdb.addr))
69345d4122cSSamudrala, Sridhar 		goto nla_put_failure;
69445d4122cSSamudrala, Sridhar 
69545d4122cSSamudrala, Sridhar 	if (obj->u.fdb.vid && nla_put_u16(dump->skb, NDA_VLAN, obj->u.fdb.vid))
69645d4122cSSamudrala, Sridhar 		goto nla_put_failure;
69745d4122cSSamudrala, Sridhar 
69845d4122cSSamudrala, Sridhar 	nlmsg_end(dump->skb, nlh);
69945d4122cSSamudrala, Sridhar 
70045d4122cSSamudrala, Sridhar skip:
70145d4122cSSamudrala, Sridhar 	dump->idx++;
70245d4122cSSamudrala, Sridhar 	return 0;
70345d4122cSSamudrala, Sridhar 
70445d4122cSSamudrala, Sridhar nla_put_failure:
70545d4122cSSamudrala, Sridhar 	nlmsg_cancel(dump->skb, nlh);
70645d4122cSSamudrala, Sridhar 	return -EMSGSIZE;
70745d4122cSSamudrala, Sridhar }
70845d4122cSSamudrala, Sridhar 
70945d4122cSSamudrala, Sridhar /**
71045d4122cSSamudrala, Sridhar  *	switchdev_port_fdb_dump - Dump port FDB (MAC/VLAN) entries
71145d4122cSSamudrala, Sridhar  *
71245d4122cSSamudrala, Sridhar  *	@skb: netlink skb
71345d4122cSSamudrala, Sridhar  *	@cb: netlink callback
71445d4122cSSamudrala, Sridhar  *	@dev: port device
71545d4122cSSamudrala, Sridhar  *	@filter_dev: filter device
71645d4122cSSamudrala, Sridhar  *	@idx:
71745d4122cSSamudrala, Sridhar  *
71845d4122cSSamudrala, Sridhar  *	Delete FDB entry from switch device.
71945d4122cSSamudrala, Sridhar  */
72045d4122cSSamudrala, Sridhar int switchdev_port_fdb_dump(struct sk_buff *skb, struct netlink_callback *cb,
72145d4122cSSamudrala, Sridhar 			    struct net_device *dev,
72245d4122cSSamudrala, Sridhar 			    struct net_device *filter_dev, int idx)
72345d4122cSSamudrala, Sridhar {
72445d4122cSSamudrala, Sridhar 	struct switchdev_fdb_dump dump = {
72545d4122cSSamudrala, Sridhar 		.obj = {
72645d4122cSSamudrala, Sridhar 			.id = SWITCHDEV_OBJ_PORT_FDB,
72745d4122cSSamudrala, Sridhar 			.cb = switchdev_port_fdb_dump_cb,
72845d4122cSSamudrala, Sridhar 		},
72945d4122cSSamudrala, Sridhar 		.skb = skb,
73045d4122cSSamudrala, Sridhar 		.cb = cb,
73145d4122cSSamudrala, Sridhar 		.filter_dev = filter_dev,
73245d4122cSSamudrala, Sridhar 		.idx = idx,
73345d4122cSSamudrala, Sridhar 	};
73445d4122cSSamudrala, Sridhar 	int err;
73545d4122cSSamudrala, Sridhar 
73645d4122cSSamudrala, Sridhar 	err = switchdev_port_obj_dump(dev, &dump.obj);
73745d4122cSSamudrala, Sridhar 	if (err)
73845d4122cSSamudrala, Sridhar 		return err;
73945d4122cSSamudrala, Sridhar 
74045d4122cSSamudrala, Sridhar 	return dump.idx;
74145d4122cSSamudrala, Sridhar }
74245d4122cSSamudrala, Sridhar EXPORT_SYMBOL_GPL(switchdev_port_fdb_dump);
74345d4122cSSamudrala, Sridhar 
744ebb9a03aSJiri Pirko static struct net_device *switchdev_get_lowest_dev(struct net_device *dev)
745b5d6fbdeSScott Feldman {
7469d47c0a2SJiri Pirko 	const struct switchdev_ops *ops = dev->switchdev_ops;
747b5d6fbdeSScott Feldman 	struct net_device *lower_dev;
748b5d6fbdeSScott Feldman 	struct net_device *port_dev;
749b5d6fbdeSScott Feldman 	struct list_head *iter;
750b5d6fbdeSScott Feldman 
751b5d6fbdeSScott Feldman 	/* Recusively search down until we find a sw port dev.
752f8e20a9fSScott Feldman 	 * (A sw port dev supports switchdev_port_attr_get).
753b5d6fbdeSScott Feldman 	 */
754b5d6fbdeSScott Feldman 
755f8e20a9fSScott Feldman 	if (ops && ops->switchdev_port_attr_get)
756b5d6fbdeSScott Feldman 		return dev;
757b5d6fbdeSScott Feldman 
758b5d6fbdeSScott Feldman 	netdev_for_each_lower_dev(dev, lower_dev, iter) {
759ebb9a03aSJiri Pirko 		port_dev = switchdev_get_lowest_dev(lower_dev);
760b5d6fbdeSScott Feldman 		if (port_dev)
761b5d6fbdeSScott Feldman 			return port_dev;
762b5d6fbdeSScott Feldman 	}
763b5d6fbdeSScott Feldman 
764b5d6fbdeSScott Feldman 	return NULL;
765b5d6fbdeSScott Feldman }
766b5d6fbdeSScott Feldman 
767ebb9a03aSJiri Pirko static struct net_device *switchdev_get_dev_by_nhs(struct fib_info *fi)
768b5d6fbdeSScott Feldman {
769f8e20a9fSScott Feldman 	struct switchdev_attr attr = {
770f8e20a9fSScott Feldman 		.id = SWITCHDEV_ATTR_PORT_PARENT_ID,
771f8e20a9fSScott Feldman 	};
772f8e20a9fSScott Feldman 	struct switchdev_attr prev_attr;
773b5d6fbdeSScott Feldman 	struct net_device *dev = NULL;
774b5d6fbdeSScott Feldman 	int nhsel;
775b5d6fbdeSScott Feldman 
776b5d6fbdeSScott Feldman 	/* For this route, all nexthop devs must be on the same switch. */
777b5d6fbdeSScott Feldman 
778b5d6fbdeSScott Feldman 	for (nhsel = 0; nhsel < fi->fib_nhs; nhsel++) {
779b5d6fbdeSScott Feldman 		const struct fib_nh *nh = &fi->fib_nh[nhsel];
780b5d6fbdeSScott Feldman 
781b5d6fbdeSScott Feldman 		if (!nh->nh_dev)
782b5d6fbdeSScott Feldman 			return NULL;
783b5d6fbdeSScott Feldman 
784ebb9a03aSJiri Pirko 		dev = switchdev_get_lowest_dev(nh->nh_dev);
785b5d6fbdeSScott Feldman 		if (!dev)
786b5d6fbdeSScott Feldman 			return NULL;
787b5d6fbdeSScott Feldman 
788f8e20a9fSScott Feldman 		if (switchdev_port_attr_get(dev, &attr))
789b5d6fbdeSScott Feldman 			return NULL;
790b5d6fbdeSScott Feldman 
791b5d6fbdeSScott Feldman 		if (nhsel > 0) {
79242275bd8SScott Feldman 			if (prev_attr.u.ppid.id_len != attr.u.ppid.id_len)
793b5d6fbdeSScott Feldman 				return NULL;
79442275bd8SScott Feldman 			if (memcmp(prev_attr.u.ppid.id, attr.u.ppid.id,
79542275bd8SScott Feldman 				   attr.u.ppid.id_len))
796b5d6fbdeSScott Feldman 				return NULL;
797b5d6fbdeSScott Feldman 		}
798b5d6fbdeSScott Feldman 
799f8e20a9fSScott Feldman 		prev_attr = attr;
800b5d6fbdeSScott Feldman 	}
801b5d6fbdeSScott Feldman 
802b5d6fbdeSScott Feldman 	return dev;
803b5d6fbdeSScott Feldman }
804b5d6fbdeSScott Feldman 
8055e8d9049SScott Feldman /**
806*7616dcbbSScott Feldman  *	switchdev_fib_ipv4_add - Add/modify switch IPv4 route entry
8075e8d9049SScott Feldman  *
8085e8d9049SScott Feldman  *	@dst: route's IPv4 destination address
8095e8d9049SScott Feldman  *	@dst_len: destination address length (prefix length)
8105e8d9049SScott Feldman  *	@fi: route FIB info structure
8115e8d9049SScott Feldman  *	@tos: route TOS
8125e8d9049SScott Feldman  *	@type: route type
813f8f21471SScott Feldman  *	@nlflags: netlink flags passed in (NLM_F_*)
8145e8d9049SScott Feldman  *	@tb_id: route table ID
8155e8d9049SScott Feldman  *
816*7616dcbbSScott Feldman  *	Add/modify switch IPv4 route entry.
8175e8d9049SScott Feldman  */
818ebb9a03aSJiri Pirko int switchdev_fib_ipv4_add(u32 dst, int dst_len, struct fib_info *fi,
819f8f21471SScott Feldman 			   u8 tos, u8 type, u32 nlflags, u32 tb_id)
8205e8d9049SScott Feldman {
82158c2cb16SScott Feldman 	struct switchdev_obj fib_obj = {
82258c2cb16SScott Feldman 		.id = SWITCHDEV_OBJ_IPV4_FIB,
82342275bd8SScott Feldman 		.u.ipv4_fib = {
8247a7ee531SScott Feldman 			.dst = dst,
82558c2cb16SScott Feldman 			.dst_len = dst_len,
82658c2cb16SScott Feldman 			.fi = fi,
82758c2cb16SScott Feldman 			.tos = tos,
82858c2cb16SScott Feldman 			.type = type,
82958c2cb16SScott Feldman 			.nlflags = nlflags,
83058c2cb16SScott Feldman 			.tb_id = tb_id,
83158c2cb16SScott Feldman 		},
83258c2cb16SScott Feldman 	};
833b5d6fbdeSScott Feldman 	struct net_device *dev;
834b5d6fbdeSScott Feldman 	int err = 0;
835b5d6fbdeSScott Feldman 
8368e05fd71SScott Feldman 	/* Don't offload route if using custom ip rules or if
8378e05fd71SScott Feldman 	 * IPv4 FIB offloading has been disabled completely.
8388e05fd71SScott Feldman 	 */
8398e05fd71SScott Feldman 
840e1315db1SScott Feldman #ifdef CONFIG_IP_MULTIPLE_TABLES
841e1315db1SScott Feldman 	if (fi->fib_net->ipv4.fib_has_custom_rules)
842e1315db1SScott Feldman 		return 0;
843e1315db1SScott Feldman #endif
844e1315db1SScott Feldman 
845e1315db1SScott Feldman 	if (fi->fib_net->ipv4.fib_offload_disabled)
846104616e7SScott Feldman 		return 0;
847104616e7SScott Feldman 
848ebb9a03aSJiri Pirko 	dev = switchdev_get_dev_by_nhs(fi);
849b5d6fbdeSScott Feldman 	if (!dev)
8505e8d9049SScott Feldman 		return 0;
851b5d6fbdeSScott Feldman 
85258c2cb16SScott Feldman 	err = switchdev_port_obj_add(dev, &fib_obj);
853b5d6fbdeSScott Feldman 	if (!err)
854eea39946SRoopa Prabhu 		fi->fib_flags |= RTNH_F_OFFLOAD;
855b5d6fbdeSScott Feldman 
856b5d6fbdeSScott Feldman 	return err;
8575e8d9049SScott Feldman }
858ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_fib_ipv4_add);
8595e8d9049SScott Feldman 
8605e8d9049SScott Feldman /**
861ebb9a03aSJiri Pirko  *	switchdev_fib_ipv4_del - Delete IPv4 route entry from switch
8625e8d9049SScott Feldman  *
8635e8d9049SScott Feldman  *	@dst: route's IPv4 destination address
8645e8d9049SScott Feldman  *	@dst_len: destination address length (prefix length)
8655e8d9049SScott Feldman  *	@fi: route FIB info structure
8665e8d9049SScott Feldman  *	@tos: route TOS
8675e8d9049SScott Feldman  *	@type: route type
8685e8d9049SScott Feldman  *	@tb_id: route table ID
8695e8d9049SScott Feldman  *
8705e8d9049SScott Feldman  *	Delete IPv4 route entry from switch device.
8715e8d9049SScott Feldman  */
872ebb9a03aSJiri Pirko int switchdev_fib_ipv4_del(u32 dst, int dst_len, struct fib_info *fi,
8735e8d9049SScott Feldman 			   u8 tos, u8 type, u32 tb_id)
8745e8d9049SScott Feldman {
87558c2cb16SScott Feldman 	struct switchdev_obj fib_obj = {
87658c2cb16SScott Feldman 		.id = SWITCHDEV_OBJ_IPV4_FIB,
87742275bd8SScott Feldman 		.u.ipv4_fib = {
8787a7ee531SScott Feldman 			.dst = dst,
87958c2cb16SScott Feldman 			.dst_len = dst_len,
88058c2cb16SScott Feldman 			.fi = fi,
88158c2cb16SScott Feldman 			.tos = tos,
88258c2cb16SScott Feldman 			.type = type,
88358c2cb16SScott Feldman 			.nlflags = 0,
88458c2cb16SScott Feldman 			.tb_id = tb_id,
88558c2cb16SScott Feldman 		},
88658c2cb16SScott Feldman 	};
887b5d6fbdeSScott Feldman 	struct net_device *dev;
888b5d6fbdeSScott Feldman 	int err = 0;
889b5d6fbdeSScott Feldman 
890eea39946SRoopa Prabhu 	if (!(fi->fib_flags & RTNH_F_OFFLOAD))
8915e8d9049SScott Feldman 		return 0;
892b5d6fbdeSScott Feldman 
893ebb9a03aSJiri Pirko 	dev = switchdev_get_dev_by_nhs(fi);
894b5d6fbdeSScott Feldman 	if (!dev)
895b5d6fbdeSScott Feldman 		return 0;
896b5d6fbdeSScott Feldman 
89758c2cb16SScott Feldman 	err = switchdev_port_obj_del(dev, &fib_obj);
898b5d6fbdeSScott Feldman 	if (!err)
899eea39946SRoopa Prabhu 		fi->fib_flags &= ~RTNH_F_OFFLOAD;
900b5d6fbdeSScott Feldman 
901b5d6fbdeSScott Feldman 	return err;
9025e8d9049SScott Feldman }
903ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_fib_ipv4_del);
9048e05fd71SScott Feldman 
9058e05fd71SScott Feldman /**
906ebb9a03aSJiri Pirko  *	switchdev_fib_ipv4_abort - Abort an IPv4 FIB operation
9078e05fd71SScott Feldman  *
9088e05fd71SScott Feldman  *	@fi: route FIB info structure
9098e05fd71SScott Feldman  */
910ebb9a03aSJiri Pirko void switchdev_fib_ipv4_abort(struct fib_info *fi)
9118e05fd71SScott Feldman {
9128e05fd71SScott Feldman 	/* There was a problem installing this route to the offload
9138e05fd71SScott Feldman 	 * device.  For now, until we come up with more refined
9148e05fd71SScott Feldman 	 * policy handling, abruptly end IPv4 fib offloading for
9158e05fd71SScott Feldman 	 * for entire net by flushing offload device(s) of all
9168e05fd71SScott Feldman 	 * IPv4 routes, and mark IPv4 fib offloading broken from
9178e05fd71SScott Feldman 	 * this point forward.
9188e05fd71SScott Feldman 	 */
9198e05fd71SScott Feldman 
9208e05fd71SScott Feldman 	fib_flush_external(fi->fib_net);
9218e05fd71SScott Feldman 	fi->fib_net->ipv4.fib_offload_disabled = true;
9228e05fd71SScott Feldman }
923ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_fib_ipv4_abort);
924