12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2007f790cSJiri Pirko /* 3007f790cSJiri Pirko * net/switchdev/switchdev.c - Switch device API 47ea6eb3fSJiri Pirko * Copyright (c) 2014-2015 Jiri Pirko <[email protected]> 5f8f21471SScott Feldman * Copyright (c) 2014-2015 Scott Feldman <[email protected]> 6007f790cSJiri Pirko */ 7007f790cSJiri Pirko 8007f790cSJiri Pirko #include <linux/kernel.h> 9007f790cSJiri Pirko #include <linux/types.h> 10007f790cSJiri Pirko #include <linux/init.h> 1103bf0c28SJiri Pirko #include <linux/mutex.h> 1203bf0c28SJiri Pirko #include <linux/notifier.h> 13007f790cSJiri Pirko #include <linux/netdevice.h> 14850d0cbcSJiri Pirko #include <linux/etherdevice.h> 1547f8328bSScott Feldman #include <linux/if_bridge.h> 167ea6eb3fSJiri Pirko #include <linux/list.h> 17793f4014SJiri Pirko #include <linux/workqueue.h> 1887aaf2caSNikolay Aleksandrov #include <linux/if_vlan.h> 194f2c6ae5SIdo Schimmel #include <linux/rtnetlink.h> 20007f790cSJiri Pirko #include <net/switchdev.h> 21007f790cSJiri Pirko 22793f4014SJiri Pirko static LIST_HEAD(deferred); 23793f4014SJiri Pirko static DEFINE_SPINLOCK(deferred_lock); 24793f4014SJiri Pirko 25793f4014SJiri Pirko typedef void switchdev_deferred_func_t(struct net_device *dev, 26793f4014SJiri Pirko const void *data); 27793f4014SJiri Pirko 28793f4014SJiri Pirko struct switchdev_deferred_item { 29793f4014SJiri Pirko struct list_head list; 30793f4014SJiri Pirko struct net_device *dev; 314fc003feSEric Dumazet netdevice_tracker dev_tracker; 32793f4014SJiri Pirko switchdev_deferred_func_t *func; 33fbfc8502SGustavo A. R. Silva unsigned long data[]; 34793f4014SJiri Pirko }; 35793f4014SJiri Pirko 36793f4014SJiri Pirko static struct switchdev_deferred_item *switchdev_deferred_dequeue(void) 37793f4014SJiri Pirko { 38793f4014SJiri Pirko struct switchdev_deferred_item *dfitem; 39793f4014SJiri Pirko 40793f4014SJiri Pirko spin_lock_bh(&deferred_lock); 41793f4014SJiri Pirko if (list_empty(&deferred)) { 42793f4014SJiri Pirko dfitem = NULL; 43793f4014SJiri Pirko goto unlock; 44793f4014SJiri Pirko } 45793f4014SJiri Pirko dfitem = list_first_entry(&deferred, 46793f4014SJiri Pirko struct switchdev_deferred_item, list); 47793f4014SJiri Pirko list_del(&dfitem->list); 48793f4014SJiri Pirko unlock: 49793f4014SJiri Pirko spin_unlock_bh(&deferred_lock); 50793f4014SJiri Pirko return dfitem; 51793f4014SJiri Pirko } 52793f4014SJiri Pirko 53793f4014SJiri Pirko /** 54793f4014SJiri Pirko * switchdev_deferred_process - Process ops in deferred queue 55793f4014SJiri Pirko * 56793f4014SJiri Pirko * Called to flush the ops currently queued in deferred ops queue. 57793f4014SJiri Pirko * rtnl_lock must be held. 58793f4014SJiri Pirko */ 59793f4014SJiri Pirko void switchdev_deferred_process(void) 60793f4014SJiri Pirko { 61793f4014SJiri Pirko struct switchdev_deferred_item *dfitem; 62793f4014SJiri Pirko 63793f4014SJiri Pirko ASSERT_RTNL(); 64793f4014SJiri Pirko 65793f4014SJiri Pirko while ((dfitem = switchdev_deferred_dequeue())) { 66793f4014SJiri Pirko dfitem->func(dfitem->dev, dfitem->data); 674fc003feSEric Dumazet dev_put_track(dfitem->dev, &dfitem->dev_tracker); 68793f4014SJiri Pirko kfree(dfitem); 69793f4014SJiri Pirko } 70793f4014SJiri Pirko } 71793f4014SJiri Pirko EXPORT_SYMBOL_GPL(switchdev_deferred_process); 72793f4014SJiri Pirko 73793f4014SJiri Pirko static void switchdev_deferred_process_work(struct work_struct *work) 74793f4014SJiri Pirko { 75793f4014SJiri Pirko rtnl_lock(); 76793f4014SJiri Pirko switchdev_deferred_process(); 77793f4014SJiri Pirko rtnl_unlock(); 78793f4014SJiri Pirko } 79793f4014SJiri Pirko 80793f4014SJiri Pirko static DECLARE_WORK(deferred_process_work, switchdev_deferred_process_work); 81793f4014SJiri Pirko 82793f4014SJiri Pirko static int switchdev_deferred_enqueue(struct net_device *dev, 83793f4014SJiri Pirko const void *data, size_t data_len, 84793f4014SJiri Pirko switchdev_deferred_func_t *func) 85793f4014SJiri Pirko { 86793f4014SJiri Pirko struct switchdev_deferred_item *dfitem; 87793f4014SJiri Pirko 88d8c28581SMinghao Chi (CGEL ZTE) dfitem = kmalloc(struct_size(dfitem, data, data_len), GFP_ATOMIC); 89793f4014SJiri Pirko if (!dfitem) 90793f4014SJiri Pirko return -ENOMEM; 91793f4014SJiri Pirko dfitem->dev = dev; 92793f4014SJiri Pirko dfitem->func = func; 93793f4014SJiri Pirko memcpy(dfitem->data, data, data_len); 944fc003feSEric Dumazet dev_hold_track(dev, &dfitem->dev_tracker, GFP_ATOMIC); 95793f4014SJiri Pirko spin_lock_bh(&deferred_lock); 96793f4014SJiri Pirko list_add_tail(&dfitem->list, &deferred); 97793f4014SJiri Pirko spin_unlock_bh(&deferred_lock); 98793f4014SJiri Pirko schedule_work(&deferred_process_work); 99793f4014SJiri Pirko return 0; 100793f4014SJiri Pirko } 101793f4014SJiri Pirko 102d45224d6SFlorian Fainelli static int switchdev_port_attr_notify(enum switchdev_notifier_type nt, 103d45224d6SFlorian Fainelli struct net_device *dev, 104dcbdf135SVladimir Oltean const struct switchdev_attr *attr, 105dcbdf135SVladimir Oltean struct netlink_ext_ack *extack) 1063094333dSScott Feldman { 107d45224d6SFlorian Fainelli int err; 108d45224d6SFlorian Fainelli int rc; 1093094333dSScott Feldman 110d45224d6SFlorian Fainelli struct switchdev_notifier_port_attr_info attr_info = { 111d45224d6SFlorian Fainelli .attr = attr, 112d45224d6SFlorian Fainelli .handled = false, 113d45224d6SFlorian Fainelli }; 1143094333dSScott Feldman 115d45224d6SFlorian Fainelli rc = call_switchdev_blocking_notifiers(nt, dev, 116dcbdf135SVladimir Oltean &attr_info.info, extack); 117d45224d6SFlorian Fainelli err = notifier_to_errno(rc); 118d45224d6SFlorian Fainelli if (err) { 119d45224d6SFlorian Fainelli WARN_ON(!attr_info.handled); 1203094333dSScott Feldman return err; 1213094333dSScott Feldman } 1223094333dSScott Feldman 123d45224d6SFlorian Fainelli if (!attr_info.handled) 124d45224d6SFlorian Fainelli return -EOPNOTSUPP; 125d45224d6SFlorian Fainelli 126d45224d6SFlorian Fainelli return 0; 127d45224d6SFlorian Fainelli } 128d45224d6SFlorian Fainelli 1290bc05d58SJiri Pirko static int switchdev_port_attr_set_now(struct net_device *dev, 130dcbdf135SVladimir Oltean const struct switchdev_attr *attr, 131dcbdf135SVladimir Oltean struct netlink_ext_ack *extack) 1323094333dSScott Feldman { 133dcbdf135SVladimir Oltean return switchdev_port_attr_notify(SWITCHDEV_PORT_ATTR_SET, dev, attr, 134dcbdf135SVladimir Oltean extack); 1353094333dSScott Feldman } 1360bc05d58SJiri Pirko 1370bc05d58SJiri Pirko static void switchdev_port_attr_set_deferred(struct net_device *dev, 1380bc05d58SJiri Pirko const void *data) 1390bc05d58SJiri Pirko { 1400bc05d58SJiri Pirko const struct switchdev_attr *attr = data; 1410bc05d58SJiri Pirko int err; 1420bc05d58SJiri Pirko 143dcbdf135SVladimir Oltean err = switchdev_port_attr_set_now(dev, attr, NULL); 1440bc05d58SJiri Pirko if (err && err != -EOPNOTSUPP) 1450bc05d58SJiri Pirko netdev_err(dev, "failed (err=%d) to set attribute (id=%d)\n", 1460bc05d58SJiri Pirko err, attr->id); 1477ceb2afbSElad Raz if (attr->complete) 1487ceb2afbSElad Raz attr->complete(dev, err, attr->complete_priv); 1490bc05d58SJiri Pirko } 1500bc05d58SJiri Pirko 1510bc05d58SJiri Pirko static int switchdev_port_attr_set_defer(struct net_device *dev, 1520bc05d58SJiri Pirko const struct switchdev_attr *attr) 1530bc05d58SJiri Pirko { 1540bc05d58SJiri Pirko return switchdev_deferred_enqueue(dev, attr, sizeof(*attr), 1550bc05d58SJiri Pirko switchdev_port_attr_set_deferred); 1560bc05d58SJiri Pirko } 1570bc05d58SJiri Pirko 1580bc05d58SJiri Pirko /** 1590bc05d58SJiri Pirko * switchdev_port_attr_set - Set port attribute 1600bc05d58SJiri Pirko * 1610bc05d58SJiri Pirko * @dev: port device 1620bc05d58SJiri Pirko * @attr: attribute to set 163dcbdf135SVladimir Oltean * @extack: netlink extended ack, for error message propagation 1640bc05d58SJiri Pirko * 1650bc05d58SJiri Pirko * rtnl_lock must be held and must not be in atomic section, 1660bc05d58SJiri Pirko * in case SWITCHDEV_F_DEFER flag is not set. 1670bc05d58SJiri Pirko */ 1680bc05d58SJiri Pirko int switchdev_port_attr_set(struct net_device *dev, 169dcbdf135SVladimir Oltean const struct switchdev_attr *attr, 170dcbdf135SVladimir Oltean struct netlink_ext_ack *extack) 1710bc05d58SJiri Pirko { 1720bc05d58SJiri Pirko if (attr->flags & SWITCHDEV_F_DEFER) 1730bc05d58SJiri Pirko return switchdev_port_attr_set_defer(dev, attr); 1740bc05d58SJiri Pirko ASSERT_RTNL(); 175dcbdf135SVladimir Oltean return switchdev_port_attr_set_now(dev, attr, extack); 1760bc05d58SJiri Pirko } 1773094333dSScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_attr_set); 1783094333dSScott Feldman 179e258d919SScott Feldman static size_t switchdev_obj_size(const struct switchdev_obj *obj) 180e258d919SScott Feldman { 181e258d919SScott Feldman switch (obj->id) { 182e258d919SScott Feldman case SWITCHDEV_OBJ_ID_PORT_VLAN: 183e258d919SScott Feldman return sizeof(struct switchdev_obj_port_vlan); 1844d41e125SElad Raz case SWITCHDEV_OBJ_ID_PORT_MDB: 1854d41e125SElad Raz return sizeof(struct switchdev_obj_port_mdb); 18647d5b6dbSAndrew Lunn case SWITCHDEV_OBJ_ID_HOST_MDB: 18747d5b6dbSAndrew Lunn return sizeof(struct switchdev_obj_port_mdb); 188e258d919SScott Feldman default: 189e258d919SScott Feldman BUG(); 190e258d919SScott Feldman } 191e258d919SScott Feldman return 0; 192e258d919SScott Feldman } 193e258d919SScott Feldman 194d17d9f5eSPetr Machata static int switchdev_port_obj_notify(enum switchdev_notifier_type nt, 195d17d9f5eSPetr Machata struct net_device *dev, 196648b4a99SJiri Pirko const struct switchdev_obj *obj, 19769b7320eSPetr Machata struct netlink_ext_ack *extack) 198491d0f15SScott Feldman { 199d17d9f5eSPetr Machata int rc; 200d17d9f5eSPetr Machata int err; 201491d0f15SScott Feldman 202d17d9f5eSPetr Machata struct switchdev_notifier_port_obj_info obj_info = { 203d17d9f5eSPetr Machata .obj = obj, 204d17d9f5eSPetr Machata .handled = false, 205d17d9f5eSPetr Machata }; 206491d0f15SScott Feldman 207479c86dcSPetr Machata rc = call_switchdev_blocking_notifiers(nt, dev, &obj_info.info, extack); 208d17d9f5eSPetr Machata err = notifier_to_errno(rc); 209d17d9f5eSPetr Machata if (err) { 210d17d9f5eSPetr Machata WARN_ON(!obj_info.handled); 211491d0f15SScott Feldman return err; 212491d0f15SScott Feldman } 213d17d9f5eSPetr Machata if (!obj_info.handled) 214d17d9f5eSPetr Machata return -EOPNOTSUPP; 215d17d9f5eSPetr Machata return 0; 216d17d9f5eSPetr Machata } 217491d0f15SScott Feldman 2184d429c5dSJiri Pirko static void switchdev_port_obj_add_deferred(struct net_device *dev, 2194d429c5dSJiri Pirko const void *data) 2204d429c5dSJiri Pirko { 2214d429c5dSJiri Pirko const struct switchdev_obj *obj = data; 2224d429c5dSJiri Pirko int err; 2234d429c5dSJiri Pirko 224cf6def51SVladimir Oltean ASSERT_RTNL(); 225cf6def51SVladimir Oltean err = switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_ADD, 226cf6def51SVladimir Oltean dev, obj, NULL); 2274d429c5dSJiri Pirko if (err && err != -EOPNOTSUPP) 2284d429c5dSJiri Pirko netdev_err(dev, "failed (err=%d) to add object (id=%d)\n", 2294d429c5dSJiri Pirko err, obj->id); 2307ceb2afbSElad Raz if (obj->complete) 2317ceb2afbSElad Raz obj->complete(dev, err, obj->complete_priv); 2324d429c5dSJiri Pirko } 2334d429c5dSJiri Pirko 2344d429c5dSJiri Pirko static int switchdev_port_obj_add_defer(struct net_device *dev, 2354d429c5dSJiri Pirko const struct switchdev_obj *obj) 2364d429c5dSJiri Pirko { 237e258d919SScott Feldman return switchdev_deferred_enqueue(dev, obj, switchdev_obj_size(obj), 2384d429c5dSJiri Pirko switchdev_port_obj_add_deferred); 2394d429c5dSJiri Pirko } 240491d0f15SScott Feldman 241491d0f15SScott Feldman /** 2424d429c5dSJiri Pirko * switchdev_port_obj_add - Add port object 243491d0f15SScott Feldman * 244491d0f15SScott Feldman * @dev: port device 2454d429c5dSJiri Pirko * @obj: object to add 246c8af73f0SAndrew Lunn * @extack: netlink extended ack 2474d429c5dSJiri Pirko * 2484d429c5dSJiri Pirko * rtnl_lock must be held and must not be in atomic section, 2494d429c5dSJiri Pirko * in case SWITCHDEV_F_DEFER flag is not set. 250491d0f15SScott Feldman */ 2514d429c5dSJiri Pirko int switchdev_port_obj_add(struct net_device *dev, 25269b7320eSPetr Machata const struct switchdev_obj *obj, 25369b7320eSPetr Machata struct netlink_ext_ack *extack) 2544d429c5dSJiri Pirko { 2554d429c5dSJiri Pirko if (obj->flags & SWITCHDEV_F_DEFER) 2564d429c5dSJiri Pirko return switchdev_port_obj_add_defer(dev, obj); 2574d429c5dSJiri Pirko ASSERT_RTNL(); 258cf6def51SVladimir Oltean return switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_ADD, 259cf6def51SVladimir Oltean dev, obj, extack); 2604d429c5dSJiri Pirko } 2614d429c5dSJiri Pirko EXPORT_SYMBOL_GPL(switchdev_port_obj_add); 2624d429c5dSJiri Pirko 2634d429c5dSJiri Pirko static int switchdev_port_obj_del_now(struct net_device *dev, 264648b4a99SJiri Pirko const struct switchdev_obj *obj) 265491d0f15SScott Feldman { 266d17d9f5eSPetr Machata return switchdev_port_obj_notify(SWITCHDEV_PORT_OBJ_DEL, 267ffb68fc5SVladimir Oltean dev, obj, NULL); 268491d0f15SScott Feldman } 2694d429c5dSJiri Pirko 2704d429c5dSJiri Pirko static void switchdev_port_obj_del_deferred(struct net_device *dev, 2714d429c5dSJiri Pirko const void *data) 2724d429c5dSJiri Pirko { 2734d429c5dSJiri Pirko const struct switchdev_obj *obj = data; 2744d429c5dSJiri Pirko int err; 2754d429c5dSJiri Pirko 2764d429c5dSJiri Pirko err = switchdev_port_obj_del_now(dev, obj); 2774d429c5dSJiri Pirko if (err && err != -EOPNOTSUPP) 2784d429c5dSJiri Pirko netdev_err(dev, "failed (err=%d) to del object (id=%d)\n", 2794d429c5dSJiri Pirko err, obj->id); 2807ceb2afbSElad Raz if (obj->complete) 2817ceb2afbSElad Raz obj->complete(dev, err, obj->complete_priv); 2824d429c5dSJiri Pirko } 2834d429c5dSJiri Pirko 2844d429c5dSJiri Pirko static int switchdev_port_obj_del_defer(struct net_device *dev, 2854d429c5dSJiri Pirko const struct switchdev_obj *obj) 2864d429c5dSJiri Pirko { 287e258d919SScott Feldman return switchdev_deferred_enqueue(dev, obj, switchdev_obj_size(obj), 2884d429c5dSJiri Pirko switchdev_port_obj_del_deferred); 2894d429c5dSJiri Pirko } 2904d429c5dSJiri Pirko 2914d429c5dSJiri Pirko /** 2924d429c5dSJiri Pirko * switchdev_port_obj_del - Delete port object 2934d429c5dSJiri Pirko * 2944d429c5dSJiri Pirko * @dev: port device 2954d429c5dSJiri Pirko * @obj: object to delete 2964d429c5dSJiri Pirko * 2974d429c5dSJiri Pirko * rtnl_lock must be held and must not be in atomic section, 2984d429c5dSJiri Pirko * in case SWITCHDEV_F_DEFER flag is not set. 2994d429c5dSJiri Pirko */ 3004d429c5dSJiri Pirko int switchdev_port_obj_del(struct net_device *dev, 3014d429c5dSJiri Pirko const struct switchdev_obj *obj) 3024d429c5dSJiri Pirko { 3034d429c5dSJiri Pirko if (obj->flags & SWITCHDEV_F_DEFER) 3044d429c5dSJiri Pirko return switchdev_port_obj_del_defer(dev, obj); 3054d429c5dSJiri Pirko ASSERT_RTNL(); 3064d429c5dSJiri Pirko return switchdev_port_obj_del_now(dev, obj); 3074d429c5dSJiri Pirko } 308491d0f15SScott Feldman EXPORT_SYMBOL_GPL(switchdev_port_obj_del); 309491d0f15SScott Feldman 310ff5cf100SArkadi Sharshevsky static ATOMIC_NOTIFIER_HEAD(switchdev_notif_chain); 311a93e3b17SPetr Machata static BLOCKING_NOTIFIER_HEAD(switchdev_blocking_notif_chain); 31203bf0c28SJiri Pirko 31303bf0c28SJiri Pirko /** 314ebb9a03aSJiri Pirko * register_switchdev_notifier - Register notifier 31503bf0c28SJiri Pirko * @nb: notifier_block 31603bf0c28SJiri Pirko * 317ff5cf100SArkadi Sharshevsky * Register switch device notifier. 31803bf0c28SJiri Pirko */ 319ebb9a03aSJiri Pirko int register_switchdev_notifier(struct notifier_block *nb) 32003bf0c28SJiri Pirko { 321ff5cf100SArkadi Sharshevsky return atomic_notifier_chain_register(&switchdev_notif_chain, nb); 32203bf0c28SJiri Pirko } 323ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(register_switchdev_notifier); 32403bf0c28SJiri Pirko 32503bf0c28SJiri Pirko /** 326ebb9a03aSJiri Pirko * unregister_switchdev_notifier - Unregister notifier 32703bf0c28SJiri Pirko * @nb: notifier_block 32803bf0c28SJiri Pirko * 32903bf0c28SJiri Pirko * Unregister switch device notifier. 33003bf0c28SJiri Pirko */ 331ebb9a03aSJiri Pirko int unregister_switchdev_notifier(struct notifier_block *nb) 33203bf0c28SJiri Pirko { 333ff5cf100SArkadi Sharshevsky return atomic_notifier_chain_unregister(&switchdev_notif_chain, nb); 33403bf0c28SJiri Pirko } 335ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(unregister_switchdev_notifier); 33603bf0c28SJiri Pirko 33703bf0c28SJiri Pirko /** 338ebb9a03aSJiri Pirko * call_switchdev_notifiers - Call notifiers 33903bf0c28SJiri Pirko * @val: value passed unmodified to notifier function 34003bf0c28SJiri Pirko * @dev: port device 34103bf0c28SJiri Pirko * @info: notifier information data 342ea6754aeSTian Tao * @extack: netlink extended ack 343ff5cf100SArkadi Sharshevsky * Call all network notifier blocks. 34403bf0c28SJiri Pirko */ 345ebb9a03aSJiri Pirko int call_switchdev_notifiers(unsigned long val, struct net_device *dev, 3466685987cSPetr Machata struct switchdev_notifier_info *info, 3476685987cSPetr Machata struct netlink_ext_ack *extack) 34803bf0c28SJiri Pirko { 34903bf0c28SJiri Pirko info->dev = dev; 3506685987cSPetr Machata info->extack = extack; 351ff5cf100SArkadi Sharshevsky return atomic_notifier_call_chain(&switchdev_notif_chain, val, info); 35203bf0c28SJiri Pirko } 353ebb9a03aSJiri Pirko EXPORT_SYMBOL_GPL(call_switchdev_notifiers); 3548a44dbb2SRoopa Prabhu 355a93e3b17SPetr Machata int register_switchdev_blocking_notifier(struct notifier_block *nb) 356a93e3b17SPetr Machata { 357a93e3b17SPetr Machata struct blocking_notifier_head *chain = &switchdev_blocking_notif_chain; 358a93e3b17SPetr Machata 359a93e3b17SPetr Machata return blocking_notifier_chain_register(chain, nb); 360a93e3b17SPetr Machata } 361a93e3b17SPetr Machata EXPORT_SYMBOL_GPL(register_switchdev_blocking_notifier); 362a93e3b17SPetr Machata 363a93e3b17SPetr Machata int unregister_switchdev_blocking_notifier(struct notifier_block *nb) 364a93e3b17SPetr Machata { 365a93e3b17SPetr Machata struct blocking_notifier_head *chain = &switchdev_blocking_notif_chain; 366a93e3b17SPetr Machata 367a93e3b17SPetr Machata return blocking_notifier_chain_unregister(chain, nb); 368a93e3b17SPetr Machata } 369a93e3b17SPetr Machata EXPORT_SYMBOL_GPL(unregister_switchdev_blocking_notifier); 370a93e3b17SPetr Machata 371a93e3b17SPetr Machata int call_switchdev_blocking_notifiers(unsigned long val, struct net_device *dev, 372479c86dcSPetr Machata struct switchdev_notifier_info *info, 373479c86dcSPetr Machata struct netlink_ext_ack *extack) 374a93e3b17SPetr Machata { 375a93e3b17SPetr Machata info->dev = dev; 376479c86dcSPetr Machata info->extack = extack; 377a93e3b17SPetr Machata return blocking_notifier_call_chain(&switchdev_blocking_notif_chain, 378a93e3b17SPetr Machata val, info); 379a93e3b17SPetr Machata } 380a93e3b17SPetr Machata EXPORT_SYMBOL_GPL(call_switchdev_blocking_notifiers); 381a93e3b17SPetr Machata 3822b0a5688SVladimir Oltean struct switchdev_nested_priv { 3832b0a5688SVladimir Oltean bool (*check_cb)(const struct net_device *dev); 3842b0a5688SVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 3852b0a5688SVladimir Oltean const struct net_device *foreign_dev); 3862b0a5688SVladimir Oltean const struct net_device *dev; 3872b0a5688SVladimir Oltean struct net_device *lower_dev; 3882b0a5688SVladimir Oltean }; 3892b0a5688SVladimir Oltean 3902b0a5688SVladimir Oltean static int switchdev_lower_dev_walk(struct net_device *lower_dev, 3912b0a5688SVladimir Oltean struct netdev_nested_priv *priv) 3922b0a5688SVladimir Oltean { 3932b0a5688SVladimir Oltean struct switchdev_nested_priv *switchdev_priv = priv->data; 3942b0a5688SVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 3952b0a5688SVladimir Oltean const struct net_device *foreign_dev); 3962b0a5688SVladimir Oltean bool (*check_cb)(const struct net_device *dev); 3972b0a5688SVladimir Oltean const struct net_device *dev; 3982b0a5688SVladimir Oltean 3992b0a5688SVladimir Oltean check_cb = switchdev_priv->check_cb; 4002b0a5688SVladimir Oltean foreign_dev_check_cb = switchdev_priv->foreign_dev_check_cb; 4012b0a5688SVladimir Oltean dev = switchdev_priv->dev; 4022b0a5688SVladimir Oltean 4032b0a5688SVladimir Oltean if (check_cb(lower_dev) && !foreign_dev_check_cb(lower_dev, dev)) { 4042b0a5688SVladimir Oltean switchdev_priv->lower_dev = lower_dev; 4052b0a5688SVladimir Oltean return 1; 4062b0a5688SVladimir Oltean } 4072b0a5688SVladimir Oltean 4082b0a5688SVladimir Oltean return 0; 4092b0a5688SVladimir Oltean } 4102b0a5688SVladimir Oltean 4112b0a5688SVladimir Oltean static struct net_device * 4127b465f4cSVladimir Oltean switchdev_lower_dev_find_rcu(struct net_device *dev, 4132b0a5688SVladimir Oltean bool (*check_cb)(const struct net_device *dev), 4142b0a5688SVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 4152b0a5688SVladimir Oltean const struct net_device *foreign_dev)) 4162b0a5688SVladimir Oltean { 4172b0a5688SVladimir Oltean struct switchdev_nested_priv switchdev_priv = { 4182b0a5688SVladimir Oltean .check_cb = check_cb, 4192b0a5688SVladimir Oltean .foreign_dev_check_cb = foreign_dev_check_cb, 4202b0a5688SVladimir Oltean .dev = dev, 4212b0a5688SVladimir Oltean .lower_dev = NULL, 4222b0a5688SVladimir Oltean }; 4232b0a5688SVladimir Oltean struct netdev_nested_priv priv = { 4242b0a5688SVladimir Oltean .data = &switchdev_priv, 4252b0a5688SVladimir Oltean }; 4262b0a5688SVladimir Oltean 4272b0a5688SVladimir Oltean netdev_walk_all_lower_dev_rcu(dev, switchdev_lower_dev_walk, &priv); 4282b0a5688SVladimir Oltean 4292b0a5688SVladimir Oltean return switchdev_priv.lower_dev; 4302b0a5688SVladimir Oltean } 4312b0a5688SVladimir Oltean 432c4076cddSVladimir Oltean static struct net_device * 433c4076cddSVladimir Oltean switchdev_lower_dev_find(struct net_device *dev, 434c4076cddSVladimir Oltean bool (*check_cb)(const struct net_device *dev), 435c4076cddSVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 436c4076cddSVladimir Oltean const struct net_device *foreign_dev)) 437c4076cddSVladimir Oltean { 438c4076cddSVladimir Oltean struct switchdev_nested_priv switchdev_priv = { 439c4076cddSVladimir Oltean .check_cb = check_cb, 440c4076cddSVladimir Oltean .foreign_dev_check_cb = foreign_dev_check_cb, 441c4076cddSVladimir Oltean .dev = dev, 442c4076cddSVladimir Oltean .lower_dev = NULL, 443c4076cddSVladimir Oltean }; 444c4076cddSVladimir Oltean struct netdev_nested_priv priv = { 445c4076cddSVladimir Oltean .data = &switchdev_priv, 446c4076cddSVladimir Oltean }; 447c4076cddSVladimir Oltean 448c4076cddSVladimir Oltean netdev_walk_all_lower_dev(dev, switchdev_lower_dev_walk, &priv); 449c4076cddSVladimir Oltean 450c4076cddSVladimir Oltean return switchdev_priv.lower_dev; 451c4076cddSVladimir Oltean } 452c4076cddSVladimir Oltean 453716a30a9SVladimir Oltean static int __switchdev_handle_fdb_event_to_device(struct net_device *dev, 454716a30a9SVladimir Oltean struct net_device *orig_dev, unsigned long event, 4558ca07176SVladimir Oltean const struct switchdev_notifier_fdb_info *fdb_info, 4568ca07176SVladimir Oltean bool (*check_cb)(const struct net_device *dev), 4578ca07176SVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 4588ca07176SVladimir Oltean const struct net_device *foreign_dev), 459716a30a9SVladimir Oltean int (*mod_cb)(struct net_device *dev, struct net_device *orig_dev, 460716a30a9SVladimir Oltean unsigned long event, const void *ctx, 4618ca07176SVladimir Oltean const struct switchdev_notifier_fdb_info *fdb_info), 462716a30a9SVladimir Oltean int (*lag_mod_cb)(struct net_device *dev, struct net_device *orig_dev, 463716a30a9SVladimir Oltean unsigned long event, const void *ctx, 4648ca07176SVladimir Oltean const struct switchdev_notifier_fdb_info *fdb_info)) 4658ca07176SVladimir Oltean { 4668ca07176SVladimir Oltean const struct switchdev_notifier_info *info = &fdb_info->info; 4672b0a5688SVladimir Oltean struct net_device *br, *lower_dev; 4688ca07176SVladimir Oltean struct list_head *iter; 4698ca07176SVladimir Oltean int err = -EOPNOTSUPP; 4708ca07176SVladimir Oltean 4712b0a5688SVladimir Oltean if (check_cb(dev)) 472716a30a9SVladimir Oltean return mod_cb(dev, orig_dev, event, info->ctx, fdb_info); 4738ca07176SVladimir Oltean 4748ca07176SVladimir Oltean if (netif_is_lag_master(dev)) { 4757b465f4cSVladimir Oltean if (!switchdev_lower_dev_find_rcu(dev, check_cb, foreign_dev_check_cb)) 4762b0a5688SVladimir Oltean goto maybe_bridged_with_us; 4772b0a5688SVladimir Oltean 4782b0a5688SVladimir Oltean /* This is a LAG interface that we offload */ 479716a30a9SVladimir Oltean if (!lag_mod_cb) 4808ca07176SVladimir Oltean return -EOPNOTSUPP; 4818ca07176SVladimir Oltean 482716a30a9SVladimir Oltean return lag_mod_cb(dev, orig_dev, event, info->ctx, fdb_info); 4838ca07176SVladimir Oltean } 4848ca07176SVladimir Oltean 4858ca07176SVladimir Oltean /* Recurse through lower interfaces in case the FDB entry is pointing 4868ca07176SVladimir Oltean * towards a bridge device. 4878ca07176SVladimir Oltean */ 4882b0a5688SVladimir Oltean if (netif_is_bridge_master(dev)) { 4897b465f4cSVladimir Oltean if (!switchdev_lower_dev_find_rcu(dev, check_cb, foreign_dev_check_cb)) 4902b0a5688SVladimir Oltean return 0; 4912b0a5688SVladimir Oltean 4922b0a5688SVladimir Oltean /* This is a bridge interface that we offload */ 4938ca07176SVladimir Oltean netdev_for_each_lower_dev(dev, lower_dev, iter) { 4948ca07176SVladimir Oltean /* Do not propagate FDB entries across bridges */ 4958ca07176SVladimir Oltean if (netif_is_bridge_master(lower_dev)) 4968ca07176SVladimir Oltean continue; 4978ca07176SVladimir Oltean 4982b0a5688SVladimir Oltean /* Bridge ports might be either us, or LAG interfaces 4992b0a5688SVladimir Oltean * that we offload. 5002b0a5688SVladimir Oltean */ 5012b0a5688SVladimir Oltean if (!check_cb(lower_dev) && 5027b465f4cSVladimir Oltean !switchdev_lower_dev_find_rcu(lower_dev, check_cb, 5032b0a5688SVladimir Oltean foreign_dev_check_cb)) 5042b0a5688SVladimir Oltean continue; 5052b0a5688SVladimir Oltean 506716a30a9SVladimir Oltean err = __switchdev_handle_fdb_event_to_device(lower_dev, orig_dev, 507716a30a9SVladimir Oltean event, fdb_info, check_cb, 5088ca07176SVladimir Oltean foreign_dev_check_cb, 509716a30a9SVladimir Oltean mod_cb, lag_mod_cb); 5108ca07176SVladimir Oltean if (err && err != -EOPNOTSUPP) 5118ca07176SVladimir Oltean return err; 5128ca07176SVladimir Oltean } 5138ca07176SVladimir Oltean 5142b0a5688SVladimir Oltean return 0; 5152b0a5688SVladimir Oltean } 5162b0a5688SVladimir Oltean 5172b0a5688SVladimir Oltean maybe_bridged_with_us: 5182b0a5688SVladimir Oltean /* Event is neither on a bridge nor a LAG. Check whether it is on an 5192b0a5688SVladimir Oltean * interface that is in a bridge with us. 5202b0a5688SVladimir Oltean */ 5212b0a5688SVladimir Oltean br = netdev_master_upper_dev_get_rcu(dev); 5222b0a5688SVladimir Oltean if (!br || !netif_is_bridge_master(br)) 5232b0a5688SVladimir Oltean return 0; 5242b0a5688SVladimir Oltean 5257b465f4cSVladimir Oltean if (!switchdev_lower_dev_find_rcu(br, check_cb, foreign_dev_check_cb)) 5262b0a5688SVladimir Oltean return 0; 5272b0a5688SVladimir Oltean 528716a30a9SVladimir Oltean return __switchdev_handle_fdb_event_to_device(br, orig_dev, event, fdb_info, 5292b0a5688SVladimir Oltean check_cb, foreign_dev_check_cb, 530716a30a9SVladimir Oltean mod_cb, lag_mod_cb); 5318ca07176SVladimir Oltean } 5328ca07176SVladimir Oltean 533716a30a9SVladimir Oltean int switchdev_handle_fdb_event_to_device(struct net_device *dev, unsigned long event, 5348ca07176SVladimir Oltean const struct switchdev_notifier_fdb_info *fdb_info, 5358ca07176SVladimir Oltean bool (*check_cb)(const struct net_device *dev), 5368ca07176SVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 5378ca07176SVladimir Oltean const struct net_device *foreign_dev), 538716a30a9SVladimir Oltean int (*mod_cb)(struct net_device *dev, struct net_device *orig_dev, 539716a30a9SVladimir Oltean unsigned long event, const void *ctx, 5408ca07176SVladimir Oltean const struct switchdev_notifier_fdb_info *fdb_info), 541716a30a9SVladimir Oltean int (*lag_mod_cb)(struct net_device *dev, struct net_device *orig_dev, 542716a30a9SVladimir Oltean unsigned long event, const void *ctx, 5438ca07176SVladimir Oltean const struct switchdev_notifier_fdb_info *fdb_info)) 5448ca07176SVladimir Oltean { 5458ca07176SVladimir Oltean int err; 5468ca07176SVladimir Oltean 547716a30a9SVladimir Oltean err = __switchdev_handle_fdb_event_to_device(dev, dev, event, fdb_info, 548716a30a9SVladimir Oltean check_cb, foreign_dev_check_cb, 549716a30a9SVladimir Oltean mod_cb, lag_mod_cb); 5508ca07176SVladimir Oltean if (err == -EOPNOTSUPP) 5518ca07176SVladimir Oltean err = 0; 5528ca07176SVladimir Oltean 5538ca07176SVladimir Oltean return err; 5548ca07176SVladimir Oltean } 555716a30a9SVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_handle_fdb_event_to_device); 5568ca07176SVladimir Oltean 557f30f0601SPetr Machata static int __switchdev_handle_port_obj_add(struct net_device *dev, 558f30f0601SPetr Machata struct switchdev_notifier_port_obj_info *port_obj_info, 559f30f0601SPetr Machata bool (*check_cb)(const struct net_device *dev), 560c4076cddSVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 561c4076cddSVladimir Oltean const struct net_device *foreign_dev), 56269bfac96SVladimir Oltean int (*add_cb)(struct net_device *dev, const void *ctx, 563f30f0601SPetr Machata const struct switchdev_obj *obj, 56469213513SPetr Machata struct netlink_ext_ack *extack)) 565f30f0601SPetr Machata { 56669bfac96SVladimir Oltean struct switchdev_notifier_info *info = &port_obj_info->info; 567*acd8df58SVladimir Oltean struct net_device *br, *lower_dev, *switchdev; 56869213513SPetr Machata struct netlink_ext_ack *extack; 569f30f0601SPetr Machata struct list_head *iter; 570f30f0601SPetr Machata int err = -EOPNOTSUPP; 571f30f0601SPetr Machata 57269bfac96SVladimir Oltean extack = switchdev_notifier_info_to_extack(info); 57369213513SPetr Machata 574f30f0601SPetr Machata if (check_cb(dev)) { 57569bfac96SVladimir Oltean err = add_cb(dev, info->ctx, port_obj_info->obj, extack); 57620776b46SRasmus Villemoes if (err != -EOPNOTSUPP) 577f30f0601SPetr Machata port_obj_info->handled = true; 57820776b46SRasmus Villemoes return err; 579f30f0601SPetr Machata } 580f30f0601SPetr Machata 581f30f0601SPetr Machata /* Switch ports might be stacked under e.g. a LAG. Ignore the 582f30f0601SPetr Machata * unsupported devices, another driver might be able to handle them. But 583f30f0601SPetr Machata * propagate to the callers any hard errors. 584f30f0601SPetr Machata * 585f30f0601SPetr Machata * If the driver does its own bookkeeping of stacked ports, it's not 586f30f0601SPetr Machata * necessary to go through this helper. 587f30f0601SPetr Machata */ 588f30f0601SPetr Machata netdev_for_each_lower_dev(dev, lower_dev, iter) { 58907c6f980SRussell King if (netif_is_bridge_master(lower_dev)) 59007c6f980SRussell King continue; 59107c6f980SRussell King 592c4076cddSVladimir Oltean /* When searching for switchdev interfaces that are neighbors 593c4076cddSVladimir Oltean * of foreign ones, and @dev is a bridge, do not recurse on the 594c4076cddSVladimir Oltean * foreign interface again, it was already visited. 595c4076cddSVladimir Oltean */ 596c4076cddSVladimir Oltean if (foreign_dev_check_cb && !check_cb(lower_dev) && 597c4076cddSVladimir Oltean !switchdev_lower_dev_find(lower_dev, check_cb, foreign_dev_check_cb)) 598c4076cddSVladimir Oltean continue; 599c4076cddSVladimir Oltean 600f30f0601SPetr Machata err = __switchdev_handle_port_obj_add(lower_dev, port_obj_info, 601c4076cddSVladimir Oltean check_cb, foreign_dev_check_cb, 602c4076cddSVladimir Oltean add_cb); 603f30f0601SPetr Machata if (err && err != -EOPNOTSUPP) 604f30f0601SPetr Machata return err; 605f30f0601SPetr Machata } 606f30f0601SPetr Machata 607c4076cddSVladimir Oltean /* Event is neither on a bridge nor a LAG. Check whether it is on an 608c4076cddSVladimir Oltean * interface that is in a bridge with us. 609c4076cddSVladimir Oltean */ 610c4076cddSVladimir Oltean if (!foreign_dev_check_cb) 611f30f0601SPetr Machata return err; 612c4076cddSVladimir Oltean 613c4076cddSVladimir Oltean br = netdev_master_upper_dev_get(dev); 614c4076cddSVladimir Oltean if (!br || !netif_is_bridge_master(br)) 615c4076cddSVladimir Oltean return err; 616c4076cddSVladimir Oltean 617*acd8df58SVladimir Oltean switchdev = switchdev_lower_dev_find(br, check_cb, foreign_dev_check_cb); 618*acd8df58SVladimir Oltean if (!switchdev) 619*acd8df58SVladimir Oltean return err; 620*acd8df58SVladimir Oltean 621*acd8df58SVladimir Oltean if (!foreign_dev_check_cb(switchdev, dev)) 622c4076cddSVladimir Oltean return err; 623c4076cddSVladimir Oltean 624c4076cddSVladimir Oltean return __switchdev_handle_port_obj_add(br, port_obj_info, check_cb, 625c4076cddSVladimir Oltean foreign_dev_check_cb, add_cb); 626f30f0601SPetr Machata } 627f30f0601SPetr Machata 628c4076cddSVladimir Oltean /* Pass through a port object addition, if @dev passes @check_cb, or replicate 629c4076cddSVladimir Oltean * it towards all lower interfaces of @dev that pass @check_cb, if @dev is a 630c4076cddSVladimir Oltean * bridge or a LAG. 631c4076cddSVladimir Oltean */ 632f30f0601SPetr Machata int switchdev_handle_port_obj_add(struct net_device *dev, 633f30f0601SPetr Machata struct switchdev_notifier_port_obj_info *port_obj_info, 634f30f0601SPetr Machata bool (*check_cb)(const struct net_device *dev), 63569bfac96SVladimir Oltean int (*add_cb)(struct net_device *dev, const void *ctx, 636f30f0601SPetr Machata const struct switchdev_obj *obj, 63769213513SPetr Machata struct netlink_ext_ack *extack)) 638f30f0601SPetr Machata { 639f30f0601SPetr Machata int err; 640f30f0601SPetr Machata 641f30f0601SPetr Machata err = __switchdev_handle_port_obj_add(dev, port_obj_info, check_cb, 642c4076cddSVladimir Oltean NULL, add_cb); 643f30f0601SPetr Machata if (err == -EOPNOTSUPP) 644f30f0601SPetr Machata err = 0; 645f30f0601SPetr Machata return err; 646f30f0601SPetr Machata } 647f30f0601SPetr Machata EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_add); 648f30f0601SPetr Machata 649c4076cddSVladimir Oltean /* Same as switchdev_handle_port_obj_add(), except if object is notified on a 650c4076cddSVladimir Oltean * @dev that passes @foreign_dev_check_cb, it is replicated towards all devices 651c4076cddSVladimir Oltean * that pass @check_cb and are in the same bridge as @dev. 652c4076cddSVladimir Oltean */ 653c4076cddSVladimir Oltean int switchdev_handle_port_obj_add_foreign(struct net_device *dev, 654c4076cddSVladimir Oltean struct switchdev_notifier_port_obj_info *port_obj_info, 655c4076cddSVladimir Oltean bool (*check_cb)(const struct net_device *dev), 656c4076cddSVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 657c4076cddSVladimir Oltean const struct net_device *foreign_dev), 658c4076cddSVladimir Oltean int (*add_cb)(struct net_device *dev, const void *ctx, 659c4076cddSVladimir Oltean const struct switchdev_obj *obj, 660c4076cddSVladimir Oltean struct netlink_ext_ack *extack)) 661c4076cddSVladimir Oltean { 662c4076cddSVladimir Oltean int err; 663c4076cddSVladimir Oltean 664c4076cddSVladimir Oltean err = __switchdev_handle_port_obj_add(dev, port_obj_info, check_cb, 665c4076cddSVladimir Oltean foreign_dev_check_cb, add_cb); 666c4076cddSVladimir Oltean if (err == -EOPNOTSUPP) 667c4076cddSVladimir Oltean err = 0; 668c4076cddSVladimir Oltean return err; 669c4076cddSVladimir Oltean } 670c4076cddSVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_add_foreign); 671c4076cddSVladimir Oltean 672f30f0601SPetr Machata static int __switchdev_handle_port_obj_del(struct net_device *dev, 673f30f0601SPetr Machata struct switchdev_notifier_port_obj_info *port_obj_info, 674f30f0601SPetr Machata bool (*check_cb)(const struct net_device *dev), 675c4076cddSVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 676c4076cddSVladimir Oltean const struct net_device *foreign_dev), 67769bfac96SVladimir Oltean int (*del_cb)(struct net_device *dev, const void *ctx, 678f30f0601SPetr Machata const struct switchdev_obj *obj)) 679f30f0601SPetr Machata { 68069bfac96SVladimir Oltean struct switchdev_notifier_info *info = &port_obj_info->info; 681*acd8df58SVladimir Oltean struct net_device *br, *lower_dev, *switchdev; 682f30f0601SPetr Machata struct list_head *iter; 683f30f0601SPetr Machata int err = -EOPNOTSUPP; 684f30f0601SPetr Machata 685f30f0601SPetr Machata if (check_cb(dev)) { 68669bfac96SVladimir Oltean err = del_cb(dev, info->ctx, port_obj_info->obj); 68720776b46SRasmus Villemoes if (err != -EOPNOTSUPP) 688f30f0601SPetr Machata port_obj_info->handled = true; 68920776b46SRasmus Villemoes return err; 690f30f0601SPetr Machata } 691f30f0601SPetr Machata 692f30f0601SPetr Machata /* Switch ports might be stacked under e.g. a LAG. Ignore the 693f30f0601SPetr Machata * unsupported devices, another driver might be able to handle them. But 694f30f0601SPetr Machata * propagate to the callers any hard errors. 695f30f0601SPetr Machata * 696f30f0601SPetr Machata * If the driver does its own bookkeeping of stacked ports, it's not 697f30f0601SPetr Machata * necessary to go through this helper. 698f30f0601SPetr Machata */ 699f30f0601SPetr Machata netdev_for_each_lower_dev(dev, lower_dev, iter) { 70007c6f980SRussell King if (netif_is_bridge_master(lower_dev)) 70107c6f980SRussell King continue; 70207c6f980SRussell King 703c4076cddSVladimir Oltean /* When searching for switchdev interfaces that are neighbors 704c4076cddSVladimir Oltean * of foreign ones, and @dev is a bridge, do not recurse on the 705c4076cddSVladimir Oltean * foreign interface again, it was already visited. 706c4076cddSVladimir Oltean */ 707c4076cddSVladimir Oltean if (foreign_dev_check_cb && !check_cb(lower_dev) && 708c4076cddSVladimir Oltean !switchdev_lower_dev_find(lower_dev, check_cb, foreign_dev_check_cb)) 709c4076cddSVladimir Oltean continue; 710c4076cddSVladimir Oltean 711f30f0601SPetr Machata err = __switchdev_handle_port_obj_del(lower_dev, port_obj_info, 712c4076cddSVladimir Oltean check_cb, foreign_dev_check_cb, 713c4076cddSVladimir Oltean del_cb); 714f30f0601SPetr Machata if (err && err != -EOPNOTSUPP) 715f30f0601SPetr Machata return err; 716f30f0601SPetr Machata } 717f30f0601SPetr Machata 718c4076cddSVladimir Oltean /* Event is neither on a bridge nor a LAG. Check whether it is on an 719c4076cddSVladimir Oltean * interface that is in a bridge with us. 720c4076cddSVladimir Oltean */ 721c4076cddSVladimir Oltean if (!foreign_dev_check_cb) 722f30f0601SPetr Machata return err; 723c4076cddSVladimir Oltean 724c4076cddSVladimir Oltean br = netdev_master_upper_dev_get(dev); 725c4076cddSVladimir Oltean if (!br || !netif_is_bridge_master(br)) 726c4076cddSVladimir Oltean return err; 727c4076cddSVladimir Oltean 728*acd8df58SVladimir Oltean switchdev = switchdev_lower_dev_find(br, check_cb, foreign_dev_check_cb); 729*acd8df58SVladimir Oltean if (!switchdev) 730*acd8df58SVladimir Oltean return err; 731*acd8df58SVladimir Oltean 732*acd8df58SVladimir Oltean if (!foreign_dev_check_cb(switchdev, dev)) 733c4076cddSVladimir Oltean return err; 734c4076cddSVladimir Oltean 735c4076cddSVladimir Oltean return __switchdev_handle_port_obj_del(br, port_obj_info, check_cb, 736c4076cddSVladimir Oltean foreign_dev_check_cb, del_cb); 737f30f0601SPetr Machata } 738f30f0601SPetr Machata 739c4076cddSVladimir Oltean /* Pass through a port object deletion, if @dev passes @check_cb, or replicate 740c4076cddSVladimir Oltean * it towards all lower interfaces of @dev that pass @check_cb, if @dev is a 741c4076cddSVladimir Oltean * bridge or a LAG. 742c4076cddSVladimir Oltean */ 743f30f0601SPetr Machata int switchdev_handle_port_obj_del(struct net_device *dev, 744f30f0601SPetr Machata struct switchdev_notifier_port_obj_info *port_obj_info, 745f30f0601SPetr Machata bool (*check_cb)(const struct net_device *dev), 74669bfac96SVladimir Oltean int (*del_cb)(struct net_device *dev, const void *ctx, 747f30f0601SPetr Machata const struct switchdev_obj *obj)) 748f30f0601SPetr Machata { 749f30f0601SPetr Machata int err; 750f30f0601SPetr Machata 751f30f0601SPetr Machata err = __switchdev_handle_port_obj_del(dev, port_obj_info, check_cb, 752c4076cddSVladimir Oltean NULL, del_cb); 753f30f0601SPetr Machata if (err == -EOPNOTSUPP) 754f30f0601SPetr Machata err = 0; 755f30f0601SPetr Machata return err; 756f30f0601SPetr Machata } 757f30f0601SPetr Machata EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_del); 7581cb33af1SFlorian Fainelli 759c4076cddSVladimir Oltean /* Same as switchdev_handle_port_obj_del(), except if object is notified on a 760c4076cddSVladimir Oltean * @dev that passes @foreign_dev_check_cb, it is replicated towards all devices 761c4076cddSVladimir Oltean * that pass @check_cb and are in the same bridge as @dev. 762c4076cddSVladimir Oltean */ 763c4076cddSVladimir Oltean int switchdev_handle_port_obj_del_foreign(struct net_device *dev, 764c4076cddSVladimir Oltean struct switchdev_notifier_port_obj_info *port_obj_info, 765c4076cddSVladimir Oltean bool (*check_cb)(const struct net_device *dev), 766c4076cddSVladimir Oltean bool (*foreign_dev_check_cb)(const struct net_device *dev, 767c4076cddSVladimir Oltean const struct net_device *foreign_dev), 768c4076cddSVladimir Oltean int (*del_cb)(struct net_device *dev, const void *ctx, 769c4076cddSVladimir Oltean const struct switchdev_obj *obj)) 770c4076cddSVladimir Oltean { 771c4076cddSVladimir Oltean int err; 772c4076cddSVladimir Oltean 773c4076cddSVladimir Oltean err = __switchdev_handle_port_obj_del(dev, port_obj_info, check_cb, 774c4076cddSVladimir Oltean foreign_dev_check_cb, del_cb); 775c4076cddSVladimir Oltean if (err == -EOPNOTSUPP) 776c4076cddSVladimir Oltean err = 0; 777c4076cddSVladimir Oltean return err; 778c4076cddSVladimir Oltean } 779c4076cddSVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_handle_port_obj_del_foreign); 780c4076cddSVladimir Oltean 7811cb33af1SFlorian Fainelli static int __switchdev_handle_port_attr_set(struct net_device *dev, 7821cb33af1SFlorian Fainelli struct switchdev_notifier_port_attr_info *port_attr_info, 7831cb33af1SFlorian Fainelli bool (*check_cb)(const struct net_device *dev), 78469bfac96SVladimir Oltean int (*set_cb)(struct net_device *dev, const void *ctx, 7854c08c586SVladimir Oltean const struct switchdev_attr *attr, 7864c08c586SVladimir Oltean struct netlink_ext_ack *extack)) 7871cb33af1SFlorian Fainelli { 78869bfac96SVladimir Oltean struct switchdev_notifier_info *info = &port_attr_info->info; 7894c08c586SVladimir Oltean struct netlink_ext_ack *extack; 7901cb33af1SFlorian Fainelli struct net_device *lower_dev; 7911cb33af1SFlorian Fainelli struct list_head *iter; 7921cb33af1SFlorian Fainelli int err = -EOPNOTSUPP; 7931cb33af1SFlorian Fainelli 79469bfac96SVladimir Oltean extack = switchdev_notifier_info_to_extack(info); 7954c08c586SVladimir Oltean 7961cb33af1SFlorian Fainelli if (check_cb(dev)) { 79769bfac96SVladimir Oltean err = set_cb(dev, info->ctx, port_attr_info->attr, extack); 79820776b46SRasmus Villemoes if (err != -EOPNOTSUPP) 7991cb33af1SFlorian Fainelli port_attr_info->handled = true; 80020776b46SRasmus Villemoes return err; 8011cb33af1SFlorian Fainelli } 8021cb33af1SFlorian Fainelli 8031cb33af1SFlorian Fainelli /* Switch ports might be stacked under e.g. a LAG. Ignore the 8041cb33af1SFlorian Fainelli * unsupported devices, another driver might be able to handle them. But 8051cb33af1SFlorian Fainelli * propagate to the callers any hard errors. 8061cb33af1SFlorian Fainelli * 8071cb33af1SFlorian Fainelli * If the driver does its own bookkeeping of stacked ports, it's not 8081cb33af1SFlorian Fainelli * necessary to go through this helper. 8091cb33af1SFlorian Fainelli */ 8101cb33af1SFlorian Fainelli netdev_for_each_lower_dev(dev, lower_dev, iter) { 81107c6f980SRussell King if (netif_is_bridge_master(lower_dev)) 81207c6f980SRussell King continue; 81307c6f980SRussell King 8141cb33af1SFlorian Fainelli err = __switchdev_handle_port_attr_set(lower_dev, port_attr_info, 8151cb33af1SFlorian Fainelli check_cb, set_cb); 8161cb33af1SFlorian Fainelli if (err && err != -EOPNOTSUPP) 8171cb33af1SFlorian Fainelli return err; 8181cb33af1SFlorian Fainelli } 8191cb33af1SFlorian Fainelli 8201cb33af1SFlorian Fainelli return err; 8211cb33af1SFlorian Fainelli } 8221cb33af1SFlorian Fainelli 8231cb33af1SFlorian Fainelli int switchdev_handle_port_attr_set(struct net_device *dev, 8241cb33af1SFlorian Fainelli struct switchdev_notifier_port_attr_info *port_attr_info, 8251cb33af1SFlorian Fainelli bool (*check_cb)(const struct net_device *dev), 82669bfac96SVladimir Oltean int (*set_cb)(struct net_device *dev, const void *ctx, 8274c08c586SVladimir Oltean const struct switchdev_attr *attr, 8284c08c586SVladimir Oltean struct netlink_ext_ack *extack)) 8291cb33af1SFlorian Fainelli { 8301cb33af1SFlorian Fainelli int err; 8311cb33af1SFlorian Fainelli 8321cb33af1SFlorian Fainelli err = __switchdev_handle_port_attr_set(dev, port_attr_info, check_cb, 8331cb33af1SFlorian Fainelli set_cb); 8341cb33af1SFlorian Fainelli if (err == -EOPNOTSUPP) 8351cb33af1SFlorian Fainelli err = 0; 8361cb33af1SFlorian Fainelli return err; 8371cb33af1SFlorian Fainelli } 8381cb33af1SFlorian Fainelli EXPORT_SYMBOL_GPL(switchdev_handle_port_attr_set); 839957e2235SVladimir Oltean 840957e2235SVladimir Oltean int switchdev_bridge_port_offload(struct net_device *brport_dev, 841957e2235SVladimir Oltean struct net_device *dev, const void *ctx, 842957e2235SVladimir Oltean struct notifier_block *atomic_nb, 843957e2235SVladimir Oltean struct notifier_block *blocking_nb, 844957e2235SVladimir Oltean bool tx_fwd_offload, 845957e2235SVladimir Oltean struct netlink_ext_ack *extack) 846957e2235SVladimir Oltean { 847957e2235SVladimir Oltean struct switchdev_notifier_brport_info brport_info = { 848957e2235SVladimir Oltean .brport = { 849957e2235SVladimir Oltean .dev = dev, 850957e2235SVladimir Oltean .ctx = ctx, 851957e2235SVladimir Oltean .atomic_nb = atomic_nb, 852957e2235SVladimir Oltean .blocking_nb = blocking_nb, 853957e2235SVladimir Oltean .tx_fwd_offload = tx_fwd_offload, 854957e2235SVladimir Oltean }, 855957e2235SVladimir Oltean }; 856957e2235SVladimir Oltean int err; 857957e2235SVladimir Oltean 858957e2235SVladimir Oltean ASSERT_RTNL(); 859957e2235SVladimir Oltean 860957e2235SVladimir Oltean err = call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_OFFLOADED, 861957e2235SVladimir Oltean brport_dev, &brport_info.info, 862957e2235SVladimir Oltean extack); 863957e2235SVladimir Oltean return notifier_to_errno(err); 864957e2235SVladimir Oltean } 865957e2235SVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_bridge_port_offload); 866957e2235SVladimir Oltean 867957e2235SVladimir Oltean void switchdev_bridge_port_unoffload(struct net_device *brport_dev, 868957e2235SVladimir Oltean const void *ctx, 869957e2235SVladimir Oltean struct notifier_block *atomic_nb, 870957e2235SVladimir Oltean struct notifier_block *blocking_nb) 871957e2235SVladimir Oltean { 872957e2235SVladimir Oltean struct switchdev_notifier_brport_info brport_info = { 873957e2235SVladimir Oltean .brport = { 874957e2235SVladimir Oltean .ctx = ctx, 875957e2235SVladimir Oltean .atomic_nb = atomic_nb, 876957e2235SVladimir Oltean .blocking_nb = blocking_nb, 877957e2235SVladimir Oltean }, 878957e2235SVladimir Oltean }; 879957e2235SVladimir Oltean 880957e2235SVladimir Oltean ASSERT_RTNL(); 881957e2235SVladimir Oltean 882957e2235SVladimir Oltean call_switchdev_blocking_notifiers(SWITCHDEV_BRPORT_UNOFFLOADED, 883957e2235SVladimir Oltean brport_dev, &brport_info.info, 884957e2235SVladimir Oltean NULL); 885957e2235SVladimir Oltean } 886957e2235SVladimir Oltean EXPORT_SYMBOL_GPL(switchdev_bridge_port_unoffload); 887