/* * net/dsa/dsa.c - Hardware switch handling * Copyright (c) 2008 Marvell Semiconductor * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. */ #include #include #include #include #include "dsa_priv.h" char dsa_driver_version[] = "0.1"; /* switch driver registration ***********************************************/ static DEFINE_MUTEX(dsa_switch_drivers_mutex); static LIST_HEAD(dsa_switch_drivers); void register_switch_driver(struct dsa_switch_driver *drv) { mutex_lock(&dsa_switch_drivers_mutex); list_add_tail(&drv->list, &dsa_switch_drivers); mutex_unlock(&dsa_switch_drivers_mutex); } void unregister_switch_driver(struct dsa_switch_driver *drv) { mutex_lock(&dsa_switch_drivers_mutex); list_del_init(&drv->list); mutex_unlock(&dsa_switch_drivers_mutex); } static struct dsa_switch_driver * dsa_switch_probe(struct mii_bus *bus, int sw_addr, char **_name) { struct dsa_switch_driver *ret; struct list_head *list; char *name; ret = NULL; name = NULL; mutex_lock(&dsa_switch_drivers_mutex); list_for_each(list, &dsa_switch_drivers) { struct dsa_switch_driver *drv; drv = list_entry(list, struct dsa_switch_driver, list); name = drv->probe(bus, sw_addr); if (name != NULL) { ret = drv; break; } } mutex_unlock(&dsa_switch_drivers_mutex); *_name = name; return ret; } /* basic switch operations **************************************************/ static struct dsa_switch * dsa_switch_setup(struct device *parent, struct dsa_platform_data *pd, struct mii_bus *bus, struct net_device *dev) { struct dsa_switch *ds; int ret; struct dsa_switch_driver *drv; char *name; int i; /* * Probe for switch model. */ drv = dsa_switch_probe(bus, pd->sw_addr, &name); if (drv == NULL) { printk(KERN_ERR "%s: could not detect attached switch\n", dev->name); return ERR_PTR(-EINVAL); } printk(KERN_INFO "%s: detected a %s switch\n", dev->name, name); /* * Allocate and initialise switch state. */ ds = kzalloc(sizeof(*ds) + drv->priv_size, GFP_KERNEL); if (ds == NULL) return ERR_PTR(-ENOMEM); ds->pd = pd; ds->master_netdev = dev; ds->master_mii_bus = bus; ds->drv = drv; ds->tag_protocol = drv->tag_protocol; /* * Validate supplied switch configuration. */ ds->cpu_port = -1; for (i = 0; i < DSA_MAX_PORTS; i++) { char *name; name = pd->port_names[i]; if (name == NULL) continue; if (!strcmp(name, "cpu")) { if (ds->cpu_port != -1) { printk(KERN_ERR "multiple cpu ports?!\n"); ret = -EINVAL; goto out; } ds->cpu_port = i; } else { ds->valid_port_mask |= 1 << i; } } if (ds->cpu_port == -1) { printk(KERN_ERR "no cpu port?!\n"); ret = -EINVAL; goto out; } /* * If we use a tagging format that doesn't have an ethertype * field, make sure that all packets from this point on get * sent to the tag format's receive function. (Which will * discard received packets until we set ds->ports[] below.) */ wmb(); dev->dsa_ptr = (void *)ds; /* * Do basic register setup. */ ret = drv->setup(ds); if (ret < 0) goto out; ret = drv->set_addr(ds, dev->dev_addr); if (ret < 0) goto out; ds->slave_mii_bus = mdiobus_alloc(); if (ds->slave_mii_bus == NULL) { ret = -ENOMEM; goto out; } dsa_slave_mii_bus_init(ds); ret = mdiobus_register(ds->slave_mii_bus); if (ret < 0) goto out_free; /* * Create network devices for physical switch ports. */ wmb(); for (i = 0; i < DSA_MAX_PORTS; i++) { struct net_device *slave_dev; if (!(ds->valid_port_mask & (1 << i))) continue; slave_dev = dsa_slave_create(ds, parent, i, pd->port_names[i]); if (slave_dev == NULL) { printk(KERN_ERR "%s: can't create dsa slave " "device for port %d(%s)\n", dev->name, i, pd->port_names[i]); continue; } ds->ports[i] = slave_dev; } return ds; out_free: mdiobus_free(ds->slave_mii_bus); out: dev->dsa_ptr = NULL; kfree(ds); return ERR_PTR(ret); } static void dsa_switch_destroy(struct dsa_switch *ds) { } /* hooks for ethertype-less tagging formats *********************************/ /* * The original DSA tag format and some other tag formats have no * ethertype, which means that we need to add a little hack to the * networking receive path to make sure that received frames get * the right ->protocol assigned to them when one of those tag * formats is in use. */ bool dsa_uses_dsa_tags(void *dsa_ptr) { struct dsa_switch *ds = dsa_ptr; return !!(ds->tag_protocol == htons(ETH_P_DSA)); } bool dsa_uses_trailer_tags(void *dsa_ptr) { struct dsa_switch *ds = dsa_ptr; return !!(ds->tag_protocol == htons(ETH_P_TRAILER)); } /* link polling *************************************************************/ static void dsa_link_poll_work(struct work_struct *ugly) { struct dsa_switch *ds; ds = container_of(ugly, struct dsa_switch, link_poll_work); ds->drv->poll_link(ds); mod_timer(&ds->link_poll_timer, round_jiffies(jiffies + HZ)); } static void dsa_link_poll_timer(unsigned long _ds) { struct dsa_switch *ds = (void *)_ds; schedule_work(&ds->link_poll_work); } /* platform driver init and cleanup *****************************************/ 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); } static struct mii_bus *dev_to_mii_bus(struct device *dev) { struct device *d; d = dev_find_class(dev, "mdio_bus"); if (d != NULL) { struct mii_bus *bus; bus = to_mii_bus(d); put_device(d); return bus; } return NULL; } static struct net_device *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; } static int dsa_probe(struct platform_device *pdev) { static int dsa_version_printed; struct dsa_platform_data *pd = pdev->dev.platform_data; struct net_device *dev; struct mii_bus *bus; struct dsa_switch *ds; if (!dsa_version_printed++) printk(KERN_NOTICE "Distributed Switch Architecture " "driver version %s\n", dsa_driver_version); if (pd == NULL || pd->mii_bus == NULL || pd->netdev == NULL) return -EINVAL; bus = dev_to_mii_bus(pd->mii_bus); if (bus == NULL) return -EINVAL; dev = dev_to_net_device(pd->netdev); if (dev == NULL) return -EINVAL; if (dev->dsa_ptr != NULL) { dev_put(dev); return -EEXIST; } ds = dsa_switch_setup(&pdev->dev, pd, bus, dev); if (IS_ERR(ds)) { dev_put(dev); return PTR_ERR(ds); } if (ds->drv->poll_link != NULL) { INIT_WORK(&ds->link_poll_work, dsa_link_poll_work); init_timer(&ds->link_poll_timer); ds->link_poll_timer.data = (unsigned long)ds; ds->link_poll_timer.function = dsa_link_poll_timer; ds->link_poll_timer.expires = round_jiffies(jiffies + HZ); add_timer(&ds->link_poll_timer); } platform_set_drvdata(pdev, ds); return 0; } static int dsa_remove(struct platform_device *pdev) { struct dsa_switch *ds = platform_get_drvdata(pdev); if (ds->drv->poll_link != NULL) del_timer_sync(&ds->link_poll_timer); flush_scheduled_work(); dsa_switch_destroy(ds); return 0; } static void dsa_shutdown(struct platform_device *pdev) { } static struct platform_driver dsa_driver = { .probe = dsa_probe, .remove = dsa_remove, .shutdown = dsa_shutdown, .driver = { .name = "dsa", .owner = THIS_MODULE, }, }; static int __init dsa_init_module(void) { return platform_driver_register(&dsa_driver); } module_init(dsa_init_module); static void __exit dsa_cleanup_module(void) { platform_driver_unregister(&dsa_driver); } module_exit(dsa_cleanup_module); MODULE_AUTHOR("Lennert Buytenhek ") MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips"); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:dsa");