[linux.git] / net / dsa / dsa.c

/*
 * net/dsa/dsa.c - Hardware switch handling
 * Copyright (c) 2008-2009 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 <linux/list.h>
#include <linux/netdevice.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <net/dsa.h>
#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 dsa_switch_tree *dst, int index,
		 struct device *parent, struct mii_bus *bus)
{
	struct dsa_chip_data *pd = dst->pd->chip + index;
	struct dsa_switch_driver *drv;
	struct dsa_switch *ds;
	int ret;
	char *name;
	int i;

	/*
	 * Probe for switch model.
	 */
	drv = dsa_switch_probe(bus, pd->sw_addr, &name);
	if (drv == NULL) {
		printk(KERN_ERR "%s[%d]: could not detect attached switch\n",
		       dst->master_netdev->name, index);
		return ERR_PTR(-EINVAL);
	}
	printk(KERN_INFO "%s[%d]: detected a %s switch\n",
		dst->master_netdev->name, index, name);


	/*
	 * Allocate and initialise switch state.
	 */
	ds = kzalloc(sizeof(*ds) + drv->priv_size, GFP_KERNEL);
	if (ds == NULL)
		return ERR_PTR(-ENOMEM);

	ds->dst = dst;
	ds->index = index;
	ds->pd = dst->pd->chip + index;
	ds->drv = drv;
	ds->master_mii_bus = bus;


	/*
	 * Validate supplied switch configuration.
	 */
	for (i = 0; i < DSA_MAX_PORTS; i++) {
		char *name;

		name = pd->port_names[i];
		if (name == NULL)
			continue;

		if (!strcmp(name, "cpu")) {
			if (dst->cpu_switch != -1) {
				printk(KERN_ERR "multiple cpu ports?!\n");
				ret = -EINVAL;
				goto out;
			}
			dst->cpu_switch = index;
			dst->cpu_port = i;
		} else if (!strcmp(name, "dsa")) {
			ds->dsa_port_mask |= 1 << i;
		} else {
			ds->phys_port_mask |= 1 << i;
		}
	}


	/*
	 * If the CPU connects to this switch, set the switch tree
	 * tagging protocol to the preferred tagging format of this
	 * switch.
	 */
	if (ds->dst->cpu_switch == index)
		ds->dst->tag_protocol = drv->tag_protocol;


	/*
	 * Do basic register setup.
	 */
	ret = drv->setup(ds);
	if (ret < 0)
		goto out;

	ret = drv->set_addr(ds, dst->master_netdev->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.
	 */
	for (i = 0; i < DSA_MAX_PORTS; i++) {
		struct net_device *slave_dev;

		if (!(ds->phys_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[%d]: can't create dsa "
			       "slave device for port %d(%s)\n",
			       dst->master_netdev->name,
			       index, i, pd->port_names[i]);
			continue;
		}

		ds->ports[i] = slave_dev;
	}

	return ds;

out_free:
	mdiobus_free(ds->slave_mii_bus);
out:
	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_tree *dst = dsa_ptr;

	return !!(dst->tag_protocol == htons(ETH_P_DSA));
}

bool dsa_uses_trailer_tags(void *dsa_ptr)
{
	struct dsa_switch_tree *dst = dsa_ptr;

	return !!(dst->tag_protocol == htons(ETH_P_TRAILER));
}


/* link polling *************************************************************/
static void dsa_link_poll_work(struct work_struct *ugly)
{
	struct dsa_switch_tree *dst;
	int i;

	dst = container_of(ugly, struct dsa_switch_tree, link_poll_work);

	for (i = 0; i < dst->pd->nr_chips; i++) {
		struct dsa_switch *ds = dst->ds[i];

		if (ds != NULL && ds->drv->poll_link != NULL)
			ds->drv->poll_link(ds);
	}

	mod_timer(&dst->link_poll_timer, round_jiffies(jiffies + HZ));
}

static void dsa_link_poll_timer(unsigned long _dst)
{
	struct dsa_switch_tree *dst = (void *)_dst;

	schedule_work(&dst->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 dsa_switch_tree *dst;
	int i;

	if (!dsa_version_printed++)
		printk(KERN_NOTICE "Distributed Switch Architecture "
			"driver version %s\n", dsa_driver_version);

	if (pd == NULL || pd->netdev == 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;
	}

	dst = kzalloc(sizeof(*dst), GFP_KERNEL);
	if (dst == NULL) {
		dev_put(dev);
		return -ENOMEM;
	}

	platform_set_drvdata(pdev, dst);

	dst->pd = pd;
	dst->master_netdev = dev;
	dst->cpu_switch = -1;
	dst->cpu_port = -1;

	for (i = 0; i < pd->nr_chips; i++) {
		struct mii_bus *bus;
		struct dsa_switch *ds;

		bus = dev_to_mii_bus(pd->chip[i].mii_bus);
		if (bus == NULL) {
			printk(KERN_ERR "%s[%d]: no mii bus found for "
				"dsa switch\n", dev->name, i);
			continue;
		}

		ds = dsa_switch_setup(dst, i, &pdev->dev, bus);
		if (IS_ERR(ds)) {
			printk(KERN_ERR "%s[%d]: couldn't create dsa switch "
				"instance (error %ld)\n", dev->name, i,
				PTR_ERR(ds));
			continue;
		}

		dst->ds[i] = ds;
		if (ds->drv->poll_link != NULL)
			dst->link_poll_needed = 1;
	}

	/*
	 * 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.
	 */
	wmb();
	dev->dsa_ptr = (void *)dst;

	if (dst->link_poll_needed) {
		INIT_WORK(&dst->link_poll_work, dsa_link_poll_work);
		init_timer(&dst->link_poll_timer);
		dst->link_poll_timer.data = (unsigned long)dst;
		dst->link_poll_timer.function = dsa_link_poll_timer;
		dst->link_poll_timer.expires = round_jiffies(jiffies + HZ);
		add_timer(&dst->link_poll_timer);
	}

	return 0;
}

static int dsa_remove(struct platform_device *pdev)
{
	struct dsa_switch_tree *dst = platform_get_drvdata(pdev);
	int i;

	if (dst->link_poll_needed)
		del_timer_sync(&dst->link_poll_timer);

	flush_work_sync(&dst->link_poll_work);

	for (i = 0; i < dst->pd->nr_chips; i++) {
		struct dsa_switch *ds = dst->ds[i];

		if (ds != NULL)
			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 <[email protected]>");
MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:dsa");
Commit	Line	Data
91da11f8 LB	1	/*
91da11f8 LB	2	* net/dsa/dsa.c - Hardware switch handling
e84665c9	3	* Copyright (c) 2008-2009 Marvell Semiconductor
91da11f8 LB	4	*
	5	* This program is free software; you can redistribute it and/or modify
	6	* it under the terms of the GNU General Public License as published by
	7	* the Free Software Foundation; either version 2 of the License, or
	8	* (at your option) any later version.
	9	*/
	10
	11	#include <linux/list.h>
	12	#include <linux/netdevice.h>
	13	#include <linux/platform_device.h>
5a0e3ad6	14	#include <linux/slab.h>
3a9a231d	15	#include <linux/module.h>
91da11f8 LB	16	#include <net/dsa.h>
	17	#include "dsa_priv.h"
	18
	19	char dsa_driver_version[] = "0.1";
	20
	21
	22	/* switch driver registration ***********************************************/
	23	static DEFINE_MUTEX(dsa_switch_drivers_mutex);
	24	static LIST_HEAD(dsa_switch_drivers);
	25
	26	void register_switch_driver(struct dsa_switch_driver *drv)
	27	{
	28	mutex_lock(&dsa_switch_drivers_mutex);
	29	list_add_tail(&drv->list, &dsa_switch_drivers);
	30	mutex_unlock(&dsa_switch_drivers_mutex);
	31	}
	32
	33	void unregister_switch_driver(struct dsa_switch_driver *drv)
	34	{
	35	mutex_lock(&dsa_switch_drivers_mutex);
	36	list_del_init(&drv->list);
	37	mutex_unlock(&dsa_switch_drivers_mutex);
	38	}
	39
	40	static struct dsa_switch_driver *
	41	dsa_switch_probe(struct mii_bus bus, int sw_addr, char *_name)
	42	{
	43	struct dsa_switch_driver *ret;
	44	struct list_head *list;
	45	char *name;
	46
	47	ret = NULL;
	48	name = NULL;
	49
	50	mutex_lock(&dsa_switch_drivers_mutex);
	51	list_for_each(list, &dsa_switch_drivers) {
	52	struct dsa_switch_driver *drv;
	53
	54	drv = list_entry(list, struct dsa_switch_driver, list);
	55
	56	name = drv->probe(bus, sw_addr);
	57	if (name != NULL) {
	58	ret = drv;
	59	break;
	60	}
	61	}
	62	mutex_unlock(&dsa_switch_drivers_mutex);
	63
	64	*_name = name;
	65
	66	return ret;
	67	}
	68
	69
	70	/* basic switch operations **************************************************/
	71	static struct dsa_switch *
e84665c9 LB	72	dsa_switch_setup(struct dsa_switch_tree *dst, int index,
e84665c9 LB	73	struct device parent, struct mii_bus bus)
91da11f8	74	{
e84665c9 LB	75	struct dsa_chip_data *pd = dst->pd->chip + index;
e84665c9 LB	76	struct dsa_switch_driver *drv;
91da11f8 LB	77	struct dsa_switch *ds;
91da11f8 LB	78	int ret;
91da11f8 LB	79	char *name;
	80	int i;
	81
	82	/*
	83	* Probe for switch model.
	84	*/
	85	drv = dsa_switch_probe(bus, pd->sw_addr, &name);
	86	if (drv == NULL) {
e84665c9 LB	87	printk(KERN_ERR "%s[%d]: could not detect attached switch\n",
e84665c9 LB	88	dst->master_netdev->name, index);
91da11f8 LB	89	return ERR_PTR(-EINVAL);
91da11f8 LB	90	}
e84665c9 LB	91	printk(KERN_INFO "%s[%d]: detected a %s switch\n",
e84665c9 LB	92	dst->master_netdev->name, index, name);
91da11f8 LB	93
	94
	95	/*
	96	* Allocate and initialise switch state.
	97	*/
	98	ds = kzalloc(sizeof(*ds) + drv->priv_size, GFP_KERNEL);
	99	if (ds == NULL)
	100	return ERR_PTR(-ENOMEM);
	101
e84665c9 LB	102	ds->dst = dst;
	103	ds->index = index;
	104	ds->pd = dst->pd->chip + index;
91da11f8	105	ds->drv = drv;
e84665c9	106	ds->master_mii_bus = bus;
91da11f8 LB	107
	108
	109	/*
	110	* Validate supplied switch configuration.
	111	*/
91da11f8 LB	112	for (i = 0; i < DSA_MAX_PORTS; i++) {
	113	char *name;
	114
	115	name = pd->port_names[i];
	116	if (name == NULL)
	117	continue;
	118
	119	if (!strcmp(name, "cpu")) {
e84665c9	120	if (dst->cpu_switch != -1) {
91da11f8 LB	121	printk(KERN_ERR "multiple cpu ports?!\n");
	122	ret = -EINVAL;
	123	goto out;
	124	}
e84665c9 LB	125	dst->cpu_switch = index;
	126	dst->cpu_port = i;
	127	} else if (!strcmp(name, "dsa")) {
	128	ds->dsa_port_mask \|= 1 << i;
91da11f8	129	} else {
e84665c9	130	ds->phys_port_mask \|= 1 << i;
91da11f8 LB	131	}
	132	}
	133
91da11f8 LB	134
91da11f8 LB	135	/*
e84665c9 LB	136	* If the CPU connects to this switch, set the switch tree
	137	* tagging protocol to the preferred tagging format of this
	138	* switch.
91da11f8	139	*/
e84665c9 LB	140	if (ds->dst->cpu_switch == index)
e84665c9 LB	141	ds->dst->tag_protocol = drv->tag_protocol;
91da11f8 LB	142
	143
	144	/*
	145	* Do basic register setup.
	146	*/
	147	ret = drv->setup(ds);
	148	if (ret < 0)
	149	goto out;
	150
e84665c9	151	ret = drv->set_addr(ds, dst->master_netdev->dev_addr);
91da11f8 LB	152	if (ret < 0)
	153	goto out;
	154
	155	ds->slave_mii_bus = mdiobus_alloc();
	156	if (ds->slave_mii_bus == NULL) {
	157	ret = -ENOMEM;
	158	goto out;
	159	}
	160	dsa_slave_mii_bus_init(ds);
	161
	162	ret = mdiobus_register(ds->slave_mii_bus);
	163	if (ret < 0)
	164	goto out_free;
	165
	166
	167	/*
	168	* Create network devices for physical switch ports.
	169	*/
91da11f8 LB	170	for (i = 0; i < DSA_MAX_PORTS; i++) {
	171	struct net_device *slave_dev;
	172
e84665c9	173	if (!(ds->phys_port_mask & (1 << i)))
91da11f8 LB	174	continue;
	175
	176	slave_dev = dsa_slave_create(ds, parent, i, pd->port_names[i]);
	177	if (slave_dev == NULL) {
e84665c9 LB	178	printk(KERN_ERR "%s[%d]: can't create dsa "
	179	"slave device for port %d(%s)\n",
	180	dst->master_netdev->name,
	181	index, i, pd->port_names[i]);
91da11f8 LB	182	continue;
	183	}
	184
	185	ds->ports[i] = slave_dev;
	186	}
	187
	188	return ds;
	189
	190	out_free:
	191	mdiobus_free(ds->slave_mii_bus);
	192	out:
91da11f8 LB	193	kfree(ds);
	194	return ERR_PTR(ret);
	195	}
	196
	197	static void dsa_switch_destroy(struct dsa_switch *ds)
	198	{
	199	}
	200
	201
cf85d08f LB	202	/* hooks for ethertype-less tagging formats *********************************/
	203	/*
	204	* The original DSA tag format and some other tag formats have no
	205	* ethertype, which means that we need to add a little hack to the
	206	* networking receive path to make sure that received frames get
	207	* the right ->protocol assigned to them when one of those tag
	208	* formats is in use.
	209	*/
	210	bool dsa_uses_dsa_tags(void *dsa_ptr)
	211	{
e84665c9	212	struct dsa_switch_tree *dst = dsa_ptr;
cf85d08f	213
e84665c9	214	return !!(dst->tag_protocol == htons(ETH_P_DSA));
cf85d08f LB	215	}
cf85d08f LB	216
396138f0 LB	217	bool dsa_uses_trailer_tags(void *dsa_ptr)
396138f0 LB	218	{
e84665c9	219	struct dsa_switch_tree *dst = dsa_ptr;
396138f0	220
e84665c9	221	return !!(dst->tag_protocol == htons(ETH_P_TRAILER));
396138f0 LB	222	}
396138f0 LB	223
cf85d08f	224
91da11f8 LB	225	/* link polling *************************************************************/
	226	static void dsa_link_poll_work(struct work_struct *ugly)
	227	{
e84665c9 LB	228	struct dsa_switch_tree *dst;
	229	int i;
	230
	231	dst = container_of(ugly, struct dsa_switch_tree, link_poll_work);
91da11f8	232
e84665c9 LB	233	for (i = 0; i < dst->pd->nr_chips; i++) {
e84665c9 LB	234	struct dsa_switch *ds = dst->ds[i];
91da11f8	235
e84665c9 LB	236	if (ds != NULL && ds->drv->poll_link != NULL)
	237	ds->drv->poll_link(ds);
	238	}
	239
	240	mod_timer(&dst->link_poll_timer, round_jiffies(jiffies + HZ));
91da11f8 LB	241	}
91da11f8 LB	242
e84665c9	243	static void dsa_link_poll_timer(unsigned long _dst)
91da11f8	244	{
e84665c9	245	struct dsa_switch_tree dst = (void )_dst;
91da11f8	246
e84665c9	247	schedule_work(&dst->link_poll_work);
91da11f8 LB	248	}
	249
	250
	251	/* platform driver init and cleanup *****************************************/
	252	static int dev_is_class(struct device dev, void class)
	253	{
	254	if (dev->class != NULL && !strcmp(dev->class->name, class))
	255	return 1;
	256
	257	return 0;
	258	}
	259
	260	static struct device dev_find_class(struct device parent, char *class)
	261	{
	262	if (dev_is_class(parent, class)) {
	263	get_device(parent);
	264	return parent;
	265	}
	266
	267	return device_find_child(parent, class, dev_is_class);
	268	}
	269
	270	static struct mii_bus dev_to_mii_bus(struct device dev)
	271	{
	272	struct device *d;
	273
	274	d = dev_find_class(dev, "mdio_bus");
	275	if (d != NULL) {
	276	struct mii_bus *bus;
	277
	278	bus = to_mii_bus(d);
	279	put_device(d);
	280
	281	return bus;
	282	}
	283
	284	return NULL;
	285	}
	286
	287	static struct net_device dev_to_net_device(struct device dev)
	288	{
	289	struct device *d;
	290
	291	d = dev_find_class(dev, "net");
	292	if (d != NULL) {
	293	struct net_device *nd;
	294
	295	nd = to_net_dev(d);
	296	dev_hold(nd);
	297	put_device(d);
	298
	299	return nd;
	300	}
	301
	302	return NULL;
	303	}
	304
	305	static int dsa_probe(struct platform_device *pdev)
	306	{
	307	static int dsa_version_printed;
	308	struct dsa_platform_data *pd = pdev->dev.platform_data;
	309	struct net_device *dev;
e84665c9 LB	310	struct dsa_switch_tree *dst;
e84665c9 LB	311	int i;
91da11f8 LB	312
	313	if (!dsa_version_printed++)
	314	printk(KERN_NOTICE "Distributed Switch Architecture "
	315	"driver version %s\n", dsa_driver_version);
	316
e84665c9	317	if (pd == NULL \|\| pd->netdev == NULL)
91da11f8 LB	318	return -EINVAL;
	319
	320	dev = dev_to_net_device(pd->netdev);
	321	if (dev == NULL)
	322	return -EINVAL;
	323
	324	if (dev->dsa_ptr != NULL) {
	325	dev_put(dev);
	326	return -EEXIST;
	327	}
	328
e84665c9 LB	329	dst = kzalloc(sizeof(*dst), GFP_KERNEL);
e84665c9 LB	330	if (dst == NULL) {
91da11f8	331	dev_put(dev);
e84665c9	332	return -ENOMEM;
91da11f8 LB	333	}
91da11f8 LB	334
e84665c9 LB	335	platform_set_drvdata(pdev, dst);
	336
	337	dst->pd = pd;
	338	dst->master_netdev = dev;
	339	dst->cpu_switch = -1;
	340	dst->cpu_port = -1;
	341
	342	for (i = 0; i < pd->nr_chips; i++) {
	343	struct mii_bus *bus;
	344	struct dsa_switch *ds;
	345
	346	bus = dev_to_mii_bus(pd->chip[i].mii_bus);
	347	if (bus == NULL) {
	348	printk(KERN_ERR "%s[%d]: no mii bus found for "
	349	"dsa switch\n", dev->name, i);
	350	continue;
	351	}
	352
	353	ds = dsa_switch_setup(dst, i, &pdev->dev, bus);
	354	if (IS_ERR(ds)) {
	355	printk(KERN_ERR "%s[%d]: couldn't create dsa switch "
	356	"instance (error %ld)\n", dev->name, i,
	357	PTR_ERR(ds));
	358	continue;
	359	}
	360
	361	dst->ds[i] = ds;
	362	if (ds->drv->poll_link != NULL)
	363	dst->link_poll_needed = 1;
91da11f8 LB	364	}
91da11f8 LB	365
e84665c9 LB	366	/*
	367	* If we use a tagging format that doesn't have an ethertype
	368	* field, make sure that all packets from this point on get
	369	* sent to the tag format's receive function.
	370	*/
	371	wmb();
	372	dev->dsa_ptr = (void *)dst;
	373
	374	if (dst->link_poll_needed) {
	375	INIT_WORK(&dst->link_poll_work, dsa_link_poll_work);
	376	init_timer(&dst->link_poll_timer);
	377	dst->link_poll_timer.data = (unsigned long)dst;
	378	dst->link_poll_timer.function = dsa_link_poll_timer;
	379	dst->link_poll_timer.expires = round_jiffies(jiffies + HZ);
	380	add_timer(&dst->link_poll_timer);
	381	}
91da11f8 LB	382
	383	return 0;
	384	}
	385
	386	static int dsa_remove(struct platform_device *pdev)
	387	{
e84665c9 LB	388	struct dsa_switch_tree *dst = platform_get_drvdata(pdev);
e84665c9 LB	389	int i;
91da11f8	390
e84665c9 LB	391	if (dst->link_poll_needed)
e84665c9 LB	392	del_timer_sync(&dst->link_poll_timer);
91da11f8	393
7f6b0db9	394	flush_work_sync(&dst->link_poll_work);
91da11f8	395
e84665c9 LB	396	for (i = 0; i < dst->pd->nr_chips; i++) {
	397	struct dsa_switch *ds = dst->ds[i];
	398
	399	if (ds != NULL)
	400	dsa_switch_destroy(ds);
	401	}
91da11f8 LB	402
	403	return 0;
	404	}
	405
	406	static void dsa_shutdown(struct platform_device *pdev)
	407	{
	408	}
	409
	410	static struct platform_driver dsa_driver = {
	411	.probe = dsa_probe,
	412	.remove = dsa_remove,
	413	.shutdown = dsa_shutdown,
	414	.driver = {
	415	.name = "dsa",
	416	.owner = THIS_MODULE,
	417	},
	418	};
	419
	420	static int __init dsa_init_module(void)
	421	{
	422	return platform_driver_register(&dsa_driver);
	423	}
	424	module_init(dsa_init_module);
	425
	426	static void __exit dsa_cleanup_module(void)
	427	{
	428	platform_driver_unregister(&dsa_driver);
	429	}
	430	module_exit(dsa_cleanup_module);
	431
577d6a7c	432	MODULE_AUTHOR("Lennert Buytenhek <[email protected]>");
91da11f8 LB	433	MODULE_DESCRIPTION("Driver for Distributed Switch Architecture switch chips");
	434	MODULE_LICENSE("GPL");
	435	MODULE_ALIAS("platform:dsa");