123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- /*
- * net/dsa/dsa.c - Hardware switch handling
- * Copyright (c) 2008-2009 Marvell Semiconductor
- * Copyright (c) 2013 Florian Fainelli <[email protected]>
- */
- #include <linux/device.h>
- #include <linux/list.h>
- #include <linux/module.h>
- #include <linux/netdevice.h>
- #include <linux/sysfs.h>
- #include <linux/ptp_classify.h>
- #include "dsa_priv.h"
- static LIST_HEAD(dsa_tag_drivers_list);
- static DEFINE_MUTEX(dsa_tag_drivers_lock);
- static struct sk_buff *dsa_slave_notag_xmit(struct sk_buff *skb,
- struct net_device *dev)
- {
- /* Just return the original SKB */
- return skb;
- }
- static const struct dsa_device_ops none_ops = {
- .name = "none",
- .proto = DSA_TAG_PROTO_NONE,
- .xmit = dsa_slave_notag_xmit,
- .rcv = NULL,
- };
- DSA_TAG_DRIVER(none_ops);
- static void dsa_tag_driver_register(struct dsa_tag_driver *dsa_tag_driver,
- struct module *owner)
- {
- dsa_tag_driver->owner = owner;
- mutex_lock(&dsa_tag_drivers_lock);
- list_add_tail(&dsa_tag_driver->list, &dsa_tag_drivers_list);
- mutex_unlock(&dsa_tag_drivers_lock);
- }
- void dsa_tag_drivers_register(struct dsa_tag_driver *dsa_tag_driver_array[],
- unsigned int count, struct module *owner)
- {
- unsigned int i;
- for (i = 0; i < count; i++)
- dsa_tag_driver_register(dsa_tag_driver_array[i], owner);
- }
- static void dsa_tag_driver_unregister(struct dsa_tag_driver *dsa_tag_driver)
- {
- mutex_lock(&dsa_tag_drivers_lock);
- list_del(&dsa_tag_driver->list);
- mutex_unlock(&dsa_tag_drivers_lock);
- }
- EXPORT_SYMBOL_GPL(dsa_tag_drivers_register);
- void dsa_tag_drivers_unregister(struct dsa_tag_driver *dsa_tag_driver_array[],
- unsigned int count)
- {
- unsigned int i;
- for (i = 0; i < count; i++)
- dsa_tag_driver_unregister(dsa_tag_driver_array[i]);
- }
- EXPORT_SYMBOL_GPL(dsa_tag_drivers_unregister);
- const char *dsa_tag_protocol_to_str(const struct dsa_device_ops *ops)
- {
- return ops->name;
- };
- /* Function takes a reference on the module owning the tagger,
- * so dsa_tag_driver_put must be called afterwards.
- */
- const struct dsa_device_ops *dsa_find_tagger_by_name(const char *buf)
- {
- const struct dsa_device_ops *ops = ERR_PTR(-ENOPROTOOPT);
- struct dsa_tag_driver *dsa_tag_driver;
- mutex_lock(&dsa_tag_drivers_lock);
- list_for_each_entry(dsa_tag_driver, &dsa_tag_drivers_list, list) {
- const struct dsa_device_ops *tmp = dsa_tag_driver->ops;
- if (!sysfs_streq(buf, tmp->name))
- continue;
- if (!try_module_get(dsa_tag_driver->owner))
- break;
- ops = tmp;
- break;
- }
- mutex_unlock(&dsa_tag_drivers_lock);
- return ops;
- }
- const struct dsa_device_ops *dsa_tag_driver_get(int tag_protocol)
- {
- struct dsa_tag_driver *dsa_tag_driver;
- const struct dsa_device_ops *ops;
- bool found = false;
- request_module("%s%d", DSA_TAG_DRIVER_ALIAS, tag_protocol);
- mutex_lock(&dsa_tag_drivers_lock);
- list_for_each_entry(dsa_tag_driver, &dsa_tag_drivers_list, list) {
- ops = dsa_tag_driver->ops;
- if (ops->proto == tag_protocol) {
- found = true;
- break;
- }
- }
- if (found) {
- if (!try_module_get(dsa_tag_driver->owner))
- ops = ERR_PTR(-ENOPROTOOPT);
- } else {
- ops = ERR_PTR(-ENOPROTOOPT);
- }
- mutex_unlock(&dsa_tag_drivers_lock);
- return ops;
- }
- void dsa_tag_driver_put(const struct dsa_device_ops *ops)
- {
- struct dsa_tag_driver *dsa_tag_driver;
- mutex_lock(&dsa_tag_drivers_lock);
- list_for_each_entry(dsa_tag_driver, &dsa_tag_drivers_list, list) {
- if (dsa_tag_driver->ops == ops) {
- module_put(dsa_tag_driver->owner);
- break;
- }
- }
- mutex_unlock(&dsa_tag_drivers_lock);
- }
- static int dev_is_class(struct device *dev, void *class)
- {
- if (dev->class != NULL && !strcmp(dev->class->name, class))
- return 1;
- return 0;
- }
- static struct device *dev_find_class(struct device *parent, char *class)
- {
- if (dev_is_class(parent, class)) {
- get_device(parent);
- return parent;
- }
- return device_find_child(parent, class, dev_is_class);
- }
- struct net_device *dsa_dev_to_net_device(struct device *dev)
- {
- struct device *d;
- d = dev_find_class(dev, "net");
- if (d != NULL) {
- struct net_device *nd;
- nd = to_net_dev(d);
- dev_hold(nd);
- put_device(d);
- return nd;
- }
- return NULL;
- }
- EXPORT_SYMBOL_GPL(dsa_dev_to_net_device);
- /* Determine if we should defer delivery of skb until we have a rx timestamp.
- *
- * Called from dsa_switch_rcv. For now, this will only work if tagging is
- * enabled on the switch. Normally the MAC driver would retrieve the hardware
- * timestamp when it reads the packet out of the hardware. However in a DSA
- * switch, the DSA driver owning the interface to which the packet is
- * delivered is never notified unless we do so here.
- */
- static bool dsa_skb_defer_rx_timestamp(struct dsa_slave_priv *p,
- struct sk_buff *skb)
- {
- struct dsa_switch *ds = p->dp->ds;
- unsigned int type;
- if (skb_headroom(skb) < ETH_HLEN)
- return false;
- __skb_push(skb, ETH_HLEN);
- type = ptp_classify_raw(skb);
- __skb_pull(skb, ETH_HLEN);
- if (type == PTP_CLASS_NONE)
- return false;
- if (likely(ds->ops->port_rxtstamp))
- return ds->ops->port_rxtstamp(ds, p->dp->index, skb, type);
- return false;
- }
- static int dsa_switch_rcv(struct sk_buff *skb, struct net_device *dev,
- struct packet_type *pt, struct net_device *unused)
- {
- struct dsa_port *cpu_dp = dev->dsa_ptr;
- struct sk_buff *nskb = NULL;
- struct dsa_slave_priv *p;
- if (unlikely(!cpu_dp)) {
- kfree_skb(skb);
- return 0;
- }
- skb = skb_unshare(skb, GFP_ATOMIC);
- if (!skb)
- return 0;
- nskb = cpu_dp->rcv(skb, dev);
- if (!nskb) {
- kfree_skb(skb);
- return 0;
- }
- skb = nskb;
- skb_push(skb, ETH_HLEN);
- skb->pkt_type = PACKET_HOST;
- skb->protocol = eth_type_trans(skb, skb->dev);
- if (unlikely(!dsa_slave_dev_check(skb->dev))) {
- /* Packet is to be injected directly on an upper
- * device, e.g. a team/bond, so skip all DSA-port
- * specific actions.
- */
- netif_rx(skb);
- return 0;
- }
- p = netdev_priv(skb->dev);
- if (unlikely(cpu_dp->ds->untag_bridge_pvid)) {
- nskb = dsa_untag_bridge_pvid(skb);
- if (!nskb) {
- kfree_skb(skb);
- return 0;
- }
- skb = nskb;
- }
- dev_sw_netstats_rx_add(skb->dev, skb->len);
- if (dsa_skb_defer_rx_timestamp(p, skb))
- return 0;
- gro_cells_receive(&p->gcells, skb);
- return 0;
- }
- #ifdef CONFIG_PM_SLEEP
- static bool dsa_port_is_initialized(const struct dsa_port *dp)
- {
- return dp->type == DSA_PORT_TYPE_USER && dp->slave;
- }
- int dsa_switch_suspend(struct dsa_switch *ds)
- {
- struct dsa_port *dp;
- int ret = 0;
- /* Suspend slave network devices */
- dsa_switch_for_each_port(dp, ds) {
- if (!dsa_port_is_initialized(dp))
- continue;
- ret = dsa_slave_suspend(dp->slave);
- if (ret)
- return ret;
- }
- if (ds->ops->suspend)
- ret = ds->ops->suspend(ds);
- return ret;
- }
- EXPORT_SYMBOL_GPL(dsa_switch_suspend);
- int dsa_switch_resume(struct dsa_switch *ds)
- {
- struct dsa_port *dp;
- int ret = 0;
- if (ds->ops->resume)
- ret = ds->ops->resume(ds);
- if (ret)
- return ret;
- /* Resume slave network devices */
- dsa_switch_for_each_port(dp, ds) {
- if (!dsa_port_is_initialized(dp))
- continue;
- ret = dsa_slave_resume(dp->slave);
- if (ret)
- return ret;
- }
- return 0;
- }
- EXPORT_SYMBOL_GPL(dsa_switch_resume);
- #endif
- static struct packet_type dsa_pack_type __read_mostly = {
- .type = cpu_to_be16(ETH_P_XDSA),
- .func = dsa_switch_rcv,
- };
- static struct workqueue_struct *dsa_owq;
- bool dsa_schedule_work(struct work_struct *work)
- {
- return queue_work(dsa_owq, work);
- }
- void dsa_flush_workqueue(void)
- {
- flush_workqueue(dsa_owq);
- }
- EXPORT_SYMBOL_GPL(dsa_flush_workqueue);
- int dsa_devlink_param_get(struct devlink *dl, u32 id,
- struct devlink_param_gset_ctx *ctx)
- {
- struct dsa_switch *ds = dsa_devlink_to_ds(dl);
- if (!ds->ops->devlink_param_get)
- return -EOPNOTSUPP;
- return ds->ops->devlink_param_get(ds, id, ctx);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_param_get);
- int dsa_devlink_param_set(struct devlink *dl, u32 id,
- struct devlink_param_gset_ctx *ctx)
- {
- struct dsa_switch *ds = dsa_devlink_to_ds(dl);
- if (!ds->ops->devlink_param_set)
- return -EOPNOTSUPP;
- return ds->ops->devlink_param_set(ds, id, ctx);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_param_set);
- int dsa_devlink_params_register(struct dsa_switch *ds,
- const struct devlink_param *params,
- size_t params_count)
- {
- return devlink_params_register(ds->devlink, params, params_count);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_params_register);
- void dsa_devlink_params_unregister(struct dsa_switch *ds,
- const struct devlink_param *params,
- size_t params_count)
- {
- devlink_params_unregister(ds->devlink, params, params_count);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_params_unregister);
- int dsa_devlink_resource_register(struct dsa_switch *ds,
- const char *resource_name,
- u64 resource_size,
- u64 resource_id,
- u64 parent_resource_id,
- const struct devlink_resource_size_params *size_params)
- {
- return devlink_resource_register(ds->devlink, resource_name,
- resource_size, resource_id,
- parent_resource_id,
- size_params);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_resource_register);
- void dsa_devlink_resources_unregister(struct dsa_switch *ds)
- {
- devlink_resources_unregister(ds->devlink);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_resources_unregister);
- void dsa_devlink_resource_occ_get_register(struct dsa_switch *ds,
- u64 resource_id,
- devlink_resource_occ_get_t *occ_get,
- void *occ_get_priv)
- {
- return devlink_resource_occ_get_register(ds->devlink, resource_id,
- occ_get, occ_get_priv);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_resource_occ_get_register);
- void dsa_devlink_resource_occ_get_unregister(struct dsa_switch *ds,
- u64 resource_id)
- {
- devlink_resource_occ_get_unregister(ds->devlink, resource_id);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_resource_occ_get_unregister);
- struct devlink_region *
- dsa_devlink_region_create(struct dsa_switch *ds,
- const struct devlink_region_ops *ops,
- u32 region_max_snapshots, u64 region_size)
- {
- return devlink_region_create(ds->devlink, ops, region_max_snapshots,
- region_size);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_region_create);
- struct devlink_region *
- dsa_devlink_port_region_create(struct dsa_switch *ds,
- int port,
- const struct devlink_port_region_ops *ops,
- u32 region_max_snapshots, u64 region_size)
- {
- struct dsa_port *dp = dsa_to_port(ds, port);
- return devlink_port_region_create(&dp->devlink_port, ops,
- region_max_snapshots,
- region_size);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_port_region_create);
- void dsa_devlink_region_destroy(struct devlink_region *region)
- {
- devlink_region_destroy(region);
- }
- EXPORT_SYMBOL_GPL(dsa_devlink_region_destroy);
- struct dsa_port *dsa_port_from_netdev(struct net_device *netdev)
- {
- if (!netdev || !dsa_slave_dev_check(netdev))
- return ERR_PTR(-ENODEV);
- return dsa_slave_to_port(netdev);
- }
- EXPORT_SYMBOL_GPL(dsa_port_from_netdev);
- bool dsa_db_equal(const struct dsa_db *a, const struct dsa_db *b)
- {
- if (a->type != b->type)
- return false;
- switch (a->type) {
- case DSA_DB_PORT:
- return a->dp == b->dp;
- case DSA_DB_LAG:
- return a->lag.dev == b->lag.dev;
- case DSA_DB_BRIDGE:
- return a->bridge.num == b->bridge.num;
- default:
- WARN_ON(1);
- return false;
- }
- }
- bool dsa_fdb_present_in_other_db(struct dsa_switch *ds, int port,
- const unsigned char *addr, u16 vid,
- struct dsa_db db)
- {
- struct dsa_port *dp = dsa_to_port(ds, port);
- struct dsa_mac_addr *a;
- lockdep_assert_held(&dp->addr_lists_lock);
- list_for_each_entry(a, &dp->fdbs, list) {
- if (!ether_addr_equal(a->addr, addr) || a->vid != vid)
- continue;
- if (a->db.type == db.type && !dsa_db_equal(&a->db, &db))
- return true;
- }
- return false;
- }
- EXPORT_SYMBOL_GPL(dsa_fdb_present_in_other_db);
- bool dsa_mdb_present_in_other_db(struct dsa_switch *ds, int port,
- const struct switchdev_obj_port_mdb *mdb,
- struct dsa_db db)
- {
- struct dsa_port *dp = dsa_to_port(ds, port);
- struct dsa_mac_addr *a;
- lockdep_assert_held(&dp->addr_lists_lock);
- list_for_each_entry(a, &dp->mdbs, list) {
- if (!ether_addr_equal(a->addr, mdb->addr) || a->vid != mdb->vid)
- continue;
- if (a->db.type == db.type && !dsa_db_equal(&a->db, &db))
- return true;
- }
- return false;
- }
- EXPORT_SYMBOL_GPL(dsa_mdb_present_in_other_db);
- static int __init dsa_init_module(void)
- {
- int rc;
- dsa_owq = alloc_ordered_workqueue("dsa_ordered",
- WQ_MEM_RECLAIM);
- if (!dsa_owq)
- return -ENOMEM;
- rc = dsa_slave_register_notifier();
- if (rc)
- goto register_notifier_fail;
- dev_add_pack(&dsa_pack_type);
- dsa_tag_driver_register(&DSA_TAG_DRIVER_NAME(none_ops),
- THIS_MODULE);
- rc = rtnl_link_register(&dsa_link_ops);
- if (rc)
- goto netlink_register_fail;
- return 0;
- netlink_register_fail:
- dsa_tag_driver_unregister(&DSA_TAG_DRIVER_NAME(none_ops));
- dsa_slave_unregister_notifier();
- dev_remove_pack(&dsa_pack_type);
- register_notifier_fail:
- destroy_workqueue(dsa_owq);
- return rc;
- }
- module_init(dsa_init_module);
- static void __exit dsa_cleanup_module(void)
- {
- rtnl_link_unregister(&dsa_link_ops);
- dsa_tag_driver_unregister(&DSA_TAG_DRIVER_NAME(none_ops));
- dsa_slave_unregister_notifier();
- dev_remove_pack(&dsa_pack_type);
- destroy_workqueue(dsa_owq);
- }
- module_exit(dsa_cleanup_module);
- MODULE_AUTHOR("Lennert Buytenhek <[email protected]>");
- MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
- MODULE_LICENSE("GPL");
- MODULE_ALIAS("platform:dsa");
|