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