[net-next-2.6.git] / drivers / net / tokenring / skisa.c

/*
 *  skisa.c: A network driver for SK-NET TMS380-based ISA token ring cards.
 *
 *  Based on tmspci written 1999 by Adam Fritzler
 *  
 *  Written 2000 by Jochen Friedrich
 *  Dedicated to my girlfriend Steffi Bopp
 *
 *  This software may be used and distributed according to the terms
 *  of the GNU General Public License, incorporated herein by reference.
 *
 *  This driver module supports the following cards:
 *	- SysKonnect TR4/16(+) ISA	(SK-4190)
 *
 *  Maintainer(s):
 *    AF        Adam Fritzler
 *    JF	Jochen Friedrich	jochen@scram.de
 *
 *  Modification History:
 *	14-Jan-01	JF	Created
 *	28-Oct-02	JF	Fixed probe of card for static compilation.
 *				Fixed module init to not make hotplug go wild.
 *	09-Nov-02	JF	Fixed early bail out on out of memory
 *				situations if multiple cards are found.
 *				Cleaned up some unnecessary console SPAM.
 *	09-Dec-02	JF	Fixed module reference counting.
 *	02-Jan-03	JF	Renamed to skisa.c
 *
 */
static const char version[] = "skisa.c: v1.03 09/12/2002 by Jochen Friedrich\n";

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/pci.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/trdevice.h>
#include <linux/platform_device.h>

#include <asm/system.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/pci.h>
#include <asm/dma.h>

#include "tms380tr.h"

#define SK_ISA_IO_EXTENT 32

/* A zero-terminated list of I/O addresses to be probed. */
static unsigned int portlist[] __initdata = {
	0x0A20, 0x1A20, 0x0B20, 0x1B20, 0x0980, 0x1980, 0x0900, 0x1900,// SK
	0
};

/* A zero-terminated list of IRQs to be probed. 
 * Used again after initial probe for sktr_chipset_init, called from sktr_open.
 */
static const unsigned short irqlist[] = {
	3, 5, 9, 10, 11, 12, 15,
	0
};

/* A zero-terminated list of DMAs to be probed. */
static int dmalist[] __initdata = {
	5, 6, 7,
	0
};

static char isa_cardname[] = "SK NET TR 4/16 ISA\0";
static u64 dma_mask = ISA_MAX_ADDRESS;
static int sk_isa_open(struct net_device *dev);
static void sk_isa_read_eeprom(struct net_device *dev);
static unsigned short sk_isa_setnselout_pins(struct net_device *dev);

static unsigned short sk_isa_sifreadb(struct net_device *dev, unsigned short reg)
{
	return inb(dev->base_addr + reg);
}

static unsigned short sk_isa_sifreadw(struct net_device *dev, unsigned short reg)
{
	return inw(dev->base_addr + reg);
}

static void sk_isa_sifwriteb(struct net_device *dev, unsigned short val, unsigned short reg)
{
	outb(val, dev->base_addr + reg);
}

static void sk_isa_sifwritew(struct net_device *dev, unsigned short val, unsigned short reg)
{
	outw(val, dev->base_addr + reg);
}


static int __init sk_isa_probe1(struct net_device *dev, int ioaddr)
{
	unsigned char old, chk1, chk2;

	if (!request_region(ioaddr, SK_ISA_IO_EXTENT, isa_cardname))
		return -ENODEV;

	old = inb(ioaddr + SIFADR);	/* Get the old SIFADR value */

	chk1 = 0;	/* Begin with check value 0 */
	do {
		/* Write new SIFADR value */
		outb(chk1, ioaddr + SIFADR);

		/* Read, invert and write */
		chk2 = inb(ioaddr + SIFADD);
		chk2 ^= 0x0FE;
		outb(chk2, ioaddr + SIFADR);

		/* Read, invert and compare */
		chk2 = inb(ioaddr + SIFADD);
		chk2 ^= 0x0FE;

		if(chk1 != chk2) {
			release_region(ioaddr, SK_ISA_IO_EXTENT);
			return -ENODEV;
		}

		chk1 -= 2;
	} while(chk1 != 0);	/* Repeat 128 times (all byte values) */

    	/* Restore the SIFADR value */
	outb(old, ioaddr + SIFADR);

	dev->base_addr = ioaddr;
	return 0;
}

static int __init setup_card(struct net_device *dev, struct device *pdev)
{
	struct net_local *tp;
        static int versionprinted;
	const unsigned *port;
	int j, err = 0;
	DECLARE_MAC_BUF(mac);

	if (!dev)
		return -ENOMEM;

	if (dev->base_addr)	/* probe specific location */
		err = sk_isa_probe1(dev, dev->base_addr);
	else {
		for (port = portlist; *port; port++) {
			err = sk_isa_probe1(dev, *port);
			if (!err)
				break;
		}
	}
	if (err)
		goto out5;

	/* At this point we have found a valid card. */

	if (versionprinted++ == 0)
		printk(KERN_DEBUG "%s", version);

	err = -EIO;
	pdev->dma_mask = &dma_mask;
	if (tmsdev_init(dev, pdev))
		goto out4;

	dev->base_addr &= ~3; 
		
	sk_isa_read_eeprom(dev);

	printk(KERN_DEBUG "skisa.c:    Ring Station Address: %s\n",
	       print_mac(mac, dev->dev_addr));
		
	tp = netdev_priv(dev);
	tp->setnselout = sk_isa_setnselout_pins;
		
	tp->sifreadb = sk_isa_sifreadb;
	tp->sifreadw = sk_isa_sifreadw;
	tp->sifwriteb = sk_isa_sifwriteb;
	tp->sifwritew = sk_isa_sifwritew;
	
	memcpy(tp->ProductID, isa_cardname, PROD_ID_SIZE + 1);

	tp->tmspriv = NULL;

	dev->open = sk_isa_open;
	dev->stop = tms380tr_close;

	if (dev->irq == 0)
	{
		for(j = 0; irqlist[j] != 0; j++)
		{
			dev->irq = irqlist[j];
			if (!request_irq(dev->irq, tms380tr_interrupt, 0, 
				isa_cardname, dev))
				break;
                }
		
                if(irqlist[j] == 0)
                {
                        printk(KERN_INFO "skisa.c: AutoSelect no IRQ available\n");
			goto out3;
		}
	}
	else
	{
		for(j = 0; irqlist[j] != 0; j++)
			if (irqlist[j] == dev->irq)
				break;
		if (irqlist[j] == 0)
		{
			printk(KERN_INFO "skisa.c: Illegal IRQ %d specified\n",
				dev->irq);
			goto out3;
		}
		if (request_irq(dev->irq, tms380tr_interrupt, 0, 
			isa_cardname, dev))
		{
                        printk(KERN_INFO "skisa.c: Selected IRQ %d not available\n",
				dev->irq);
			goto out3;
		}
	}

	if (dev->dma == 0)
	{
		for(j = 0; dmalist[j] != 0; j++)
		{
			dev->dma = dmalist[j];
                        if (!request_dma(dev->dma, isa_cardname))
				break;
		}

		if(dmalist[j] == 0)
		{
			printk(KERN_INFO "skisa.c: AutoSelect no DMA available\n");
			goto out2;
		}
	}
	else
	{
		for(j = 0; dmalist[j] != 0; j++)
			if (dmalist[j] == dev->dma)
				break;
		if (dmalist[j] == 0)
		{
                        printk(KERN_INFO "skisa.c: Illegal DMA %d specified\n",
				dev->dma);
			goto out2;
		}
		if (request_dma(dev->dma, isa_cardname))
		{
                        printk(KERN_INFO "skisa.c: Selected DMA %d not available\n",
				dev->dma);
			goto out2;
		}
	}

	err = register_netdev(dev);
	if (err)
		goto out;

	printk(KERN_DEBUG "%s:    IO: %#4lx  IRQ: %d  DMA: %d\n",
	       dev->name, dev->base_addr, dev->irq, dev->dma);

	return 0;
out:
	free_dma(dev->dma);
out2:
	free_irq(dev->irq, dev);
out3:
	tmsdev_term(dev);
out4:
	release_region(dev->base_addr, SK_ISA_IO_EXTENT);
out5:
	return err;
}

/*
 * Reads MAC address from adapter RAM, which should've read it from
 * the onboard ROM.  
 *
 * Calling this on a board that does not support it can be a very
 * dangerous thing.  The Madge board, for instance, will lock your
 * machine hard when this is called.  Luckily, its supported in a
 * separate driver.  --ASF
 */
static void sk_isa_read_eeprom(struct net_device *dev)
{
	int i;
	
	/* Address: 0000:0000 */
	sk_isa_sifwritew(dev, 0, SIFADX);
	sk_isa_sifwritew(dev, 0, SIFADR);	
	
	/* Read six byte MAC address data */
	dev->addr_len = 6;
	for(i = 0; i < 6; i++)
		dev->dev_addr[i] = sk_isa_sifreadw(dev, SIFINC) >> 8;
}

unsigned short sk_isa_setnselout_pins(struct net_device *dev)
{
	return 0;
}

static int sk_isa_open(struct net_device *dev)
{  
	struct net_local *tp = netdev_priv(dev);
	unsigned short val = 0;
	unsigned short oldval;
	int i;

	val = 0;
	for(i = 0; irqlist[i] != 0; i++)
	{
		if(irqlist[i] == dev->irq)
			break;
	}

	val |= CYCLE_TIME << 2;
	val |= i << 4;
	i = dev->dma - 5;
	val |= i;
	if(tp->DataRate == SPEED_4)
		val |= LINE_SPEED_BIT;
	else
		val &= ~LINE_SPEED_BIT;
	oldval = sk_isa_sifreadb(dev, POSREG);
	/* Leave cycle bits alone */
	oldval |= 0xf3;
	val &= oldval;
	sk_isa_sifwriteb(dev, val, POSREG);

	return tms380tr_open(dev);
}

#define ISATR_MAX_ADAPTERS 3

static int io[ISATR_MAX_ADAPTERS];
static int irq[ISATR_MAX_ADAPTERS];
static int dma[ISATR_MAX_ADAPTERS];

MODULE_LICENSE("GPL");

module_param_array(io, int, NULL, 0);
module_param_array(irq, int, NULL, 0);
module_param_array(dma, int, NULL, 0);

static struct platform_device *sk_isa_dev[ISATR_MAX_ADAPTERS];

static struct platform_driver sk_isa_driver = {
	.driver		= {
		.name	= "skisa",
	},
};

static int __init sk_isa_init(void)
{
	struct net_device *dev;
	struct platform_device *pdev;
	int i, num = 0, err = 0;

	err = platform_driver_register(&sk_isa_driver);
	if (err)
		return err;

	for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
		dev = alloc_trdev(sizeof(struct net_local));
		if (!dev)
			continue;

		dev->base_addr = io[i];
		dev->irq = irq[i];
		dev->dma = dma[i];
		pdev = platform_device_register_simple("skisa",
			i, NULL, 0);
		if (IS_ERR(pdev)) {
			free_netdev(dev);
			continue;
		}
		err = setup_card(dev, &pdev->dev);
		if (!err) {
			sk_isa_dev[i] = pdev;
			platform_set_drvdata(sk_isa_dev[i], dev);
			++num;
		} else {
			platform_device_unregister(pdev);
			free_netdev(dev);
		}
	}

	printk(KERN_NOTICE "skisa.c: %d cards found.\n", num);
	/* Probe for cards. */
	if (num == 0) {
		printk(KERN_NOTICE "skisa.c: No cards found.\n");
		platform_driver_unregister(&sk_isa_driver);
		return -ENODEV;
	}
	return 0;
}

static void __exit sk_isa_cleanup(void)
{
	struct net_device *dev;
	int i;

	for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
		struct platform_device *pdev = sk_isa_dev[i];

		if (!pdev)
			continue;
		dev = platform_get_drvdata(pdev);
		unregister_netdev(dev);
		release_region(dev->base_addr, SK_ISA_IO_EXTENT);
		free_irq(dev->irq, dev);
		free_dma(dev->dma);
		tmsdev_term(dev);
		free_netdev(dev);
		platform_set_drvdata(pdev, NULL);
		platform_device_unregister(pdev);
	}
	platform_driver_unregister(&sk_isa_driver);
}

module_init(sk_isa_init);
module_exit(sk_isa_cleanup);
Commit	Line	Data
1da177e4 LT	1	/*
	2	* skisa.c: A network driver for SK-NET TMS380-based ISA token ring cards.
	3	*
	4	* Based on tmspci written 1999 by Adam Fritzler
	5	*
	6	* Written 2000 by Jochen Friedrich
	7	* Dedicated to my girlfriend Steffi Bopp
	8	*
	9	* This software may be used and distributed according to the terms
	10	* of the GNU General Public License, incorporated herein by reference.
	11	*
	12	* This driver module supports the following cards:
	13	* - SysKonnect TR4/16(+) ISA (SK-4190)
	14	*
	15	* Maintainer(s):
726a6459	16	* AF Adam Fritzler
1da177e4 LT	17	* JF Jochen Friedrich jochen@scram.de
	18	*
	19	* Modification History:
	20	* 14-Jan-01 JF Created
	21	* 28-Oct-02 JF Fixed probe of card for static compilation.
	22	* Fixed module init to not make hotplug go wild.
	23	* 09-Nov-02 JF Fixed early bail out on out of memory
	24	* situations if multiple cards are found.
	25	* Cleaned up some unnecessary console SPAM.
	26	* 09-Dec-02 JF Fixed module reference counting.
	27	* 02-Jan-03 JF Renamed to skisa.c
	28	*
	29	*/
	30	static const char version[] = "skisa.c: v1.03 09/12/2002 by Jochen Friedrich\n";
	31
	32	#include <linux/module.h>
	33	#include <linux/kernel.h>
	34	#include <linux/errno.h>
	35	#include <linux/pci.h>
	36	#include <linux/init.h>
	37	#include <linux/netdevice.h>
	38	#include <linux/trdevice.h>
d052d1be	39	#include <linux/platform_device.h>
1da177e4 LT	40
	41	#include <asm/system.h>
	42	#include <asm/io.h>
	43	#include <asm/irq.h>
	44	#include <asm/pci.h>
	45	#include <asm/dma.h>
	46
	47	#include "tms380tr.h"
	48
	49	#define SK_ISA_IO_EXTENT 32
	50
	51	/* A zero-terminated list of I/O addresses to be probed. */
	52	static unsigned int portlist[] __initdata = {
	53	0x0A20, 0x1A20, 0x0B20, 0x1B20, 0x0980, 0x1980, 0x0900, 0x1900,// SK
	54	0
	55	};
	56
	57	/* A zero-terminated list of IRQs to be probed.
	58	* Used again after initial probe for sktr_chipset_init, called from sktr_open.
	59	*/
	60	static const unsigned short irqlist[] = {
	61	3, 5, 9, 10, 11, 12, 15,
	62	0
	63	};
	64
	65	/* A zero-terminated list of DMAs to be probed. */
	66	static int dmalist[] __initdata = {
	67	5, 6, 7,
	68	0
	69	};
	70
	71	static char isa_cardname[] = "SK NET TR 4/16 ISA\0";
504ff16c	72	static u64 dma_mask = ISA_MAX_ADDRESS;
1da177e4 LT	73	static int sk_isa_open(struct net_device *dev);
	74	static void sk_isa_read_eeprom(struct net_device *dev);
	75	static unsigned short sk_isa_setnselout_pins(struct net_device *dev);
	76
	77	static unsigned short sk_isa_sifreadb(struct net_device *dev, unsigned short reg)
	78	{
	79	return inb(dev->base_addr + reg);
	80	}
	81
	82	static unsigned short sk_isa_sifreadw(struct net_device *dev, unsigned short reg)
	83	{
	84	return inw(dev->base_addr + reg);
	85	}
	86
	87	static void sk_isa_sifwriteb(struct net_device *dev, unsigned short val, unsigned short reg)
	88	{
	89	outb(val, dev->base_addr + reg);
	90	}
	91
	92	static void sk_isa_sifwritew(struct net_device *dev, unsigned short val, unsigned short reg)
	93	{
	94	outw(val, dev->base_addr + reg);
	95	}
	96
	97
	98	static int __init sk_isa_probe1(struct net_device *dev, int ioaddr)
	99	{
	100	unsigned char old, chk1, chk2;
	101
	102	if (!request_region(ioaddr, SK_ISA_IO_EXTENT, isa_cardname))
	103	return -ENODEV;
	104
	105	old = inb(ioaddr + SIFADR); /* Get the old SIFADR value */
	106
	107	chk1 = 0; /* Begin with check value 0 */
	108	do {
	109	/* Write new SIFADR value */
	110	outb(chk1, ioaddr + SIFADR);
	111
	112	/* Read, invert and write */
	113	chk2 = inb(ioaddr + SIFADD);
	114	chk2 ^= 0x0FE;
	115	outb(chk2, ioaddr + SIFADR);
	116
	117	/* Read, invert and compare */
	118	chk2 = inb(ioaddr + SIFADD);
	119	chk2 ^= 0x0FE;
	120
	121	if(chk1 != chk2) {
	122	release_region(ioaddr, SK_ISA_IO_EXTENT);
	123	return -ENODEV;
	124	}
	125
	126	chk1 -= 2;
	127	} while(chk1 != 0); /* Repeat 128 times (all byte values) */
	128
	129	/* Restore the SIFADR value */
	130	outb(old, ioaddr + SIFADR);
	131
	132	dev->base_addr = ioaddr;
	133	return 0;
	134	}
	135
504ff16c	136	static int __init setup_card(struct net_device dev, struct device pdev)
1da177e4 LT	137	{
	138	struct net_local *tp;
	139	static int versionprinted;
	140	const unsigned *port;
	141	int j, err = 0;
0795af57	142	DECLARE_MAC_BUF(mac);
1da177e4 LT	143
	144	if (!dev)
	145	return -ENOMEM;
	146
1da177e4 LT	147	if (dev->base_addr) /* probe specific location */
	148	err = sk_isa_probe1(dev, dev->base_addr);
	149	else {
	150	for (port = portlist; *port; port++) {
	151	err = sk_isa_probe1(dev, *port);
	152	if (!err)
	153	break;
	154	}
	155	}
	156	if (err)
504ff16c	157	goto out5;
1da177e4 LT	158
	159	/* At this point we have found a valid card. */
	160
	161	if (versionprinted++ == 0)
	162	printk(KERN_DEBUG "%s", version);
	163
	164	err = -EIO;
504ff16c	165	pdev->dma_mask = &dma_mask;
84c3ea01	166	if (tmsdev_init(dev, pdev))
1da177e4 LT	167	goto out4;
	168
	169	dev->base_addr &= ~3;
	170
	171	sk_isa_read_eeprom(dev);
	172
0795af57 JP	173	printk(KERN_DEBUG "skisa.c: Ring Station Address: %s\n",
0795af57 JP	174	print_mac(mac, dev->dev_addr));
1da177e4 LT	175
	176	tp = netdev_priv(dev);
	177	tp->setnselout = sk_isa_setnselout_pins;
	178
	179	tp->sifreadb = sk_isa_sifreadb;
	180	tp->sifreadw = sk_isa_sifreadw;
	181	tp->sifwriteb = sk_isa_sifwriteb;
	182	tp->sifwritew = sk_isa_sifwritew;
	183
	184	memcpy(tp->ProductID, isa_cardname, PROD_ID_SIZE + 1);
	185
	186	tp->tmspriv = NULL;
	187
	188	dev->open = sk_isa_open;
	189	dev->stop = tms380tr_close;
	190
	191	if (dev->irq == 0)
	192	{
	193	for(j = 0; irqlist[j] != 0; j++)
	194	{
	195	dev->irq = irqlist[j];
	196	if (!request_irq(dev->irq, tms380tr_interrupt, 0,
	197	isa_cardname, dev))
	198	break;
	199	}
	200
	201	if(irqlist[j] == 0)
	202	{
504ff16c	203	printk(KERN_INFO "skisa.c: AutoSelect no IRQ available\n");
1da177e4 LT	204	goto out3;
	205	}
	206	}
	207	else
	208	{
	209	for(j = 0; irqlist[j] != 0; j++)
	210	if (irqlist[j] == dev->irq)
	211	break;
	212	if (irqlist[j] == 0)
	213	{
504ff16c JF	214	printk(KERN_INFO "skisa.c: Illegal IRQ %d specified\n",
504ff16c JF	215	dev->irq);
1da177e4 LT	216	goto out3;
	217	}
	218	if (request_irq(dev->irq, tms380tr_interrupt, 0,
	219	isa_cardname, dev))
	220	{
504ff16c JF	221	printk(KERN_INFO "skisa.c: Selected IRQ %d not available\n",
504ff16c JF	222	dev->irq);
1da177e4 LT	223	goto out3;
	224	}
	225	}
	226
	227	if (dev->dma == 0)
	228	{
	229	for(j = 0; dmalist[j] != 0; j++)
	230	{
	231	dev->dma = dmalist[j];
	232	if (!request_dma(dev->dma, isa_cardname))
	233	break;
	234	}
	235
	236	if(dmalist[j] == 0)
	237	{
504ff16c	238	printk(KERN_INFO "skisa.c: AutoSelect no DMA available\n");
1da177e4 LT	239	goto out2;
	240	}
	241	}
	242	else
	243	{
	244	for(j = 0; dmalist[j] != 0; j++)
	245	if (dmalist[j] == dev->dma)
	246	break;
	247	if (dmalist[j] == 0)
	248	{
504ff16c JF	249	printk(KERN_INFO "skisa.c: Illegal DMA %d specified\n",
504ff16c JF	250	dev->dma);
1da177e4 LT	251	goto out2;
	252	}
	253	if (request_dma(dev->dma, isa_cardname))
	254	{
504ff16c JF	255	printk(KERN_INFO "skisa.c: Selected DMA %d not available\n",
504ff16c JF	256	dev->dma);
1da177e4 LT	257	goto out2;
	258	}
	259	}
	260
1da177e4 LT	261	err = register_netdev(dev);
	262	if (err)
	263	goto out;
	264
504ff16c JF	265	printk(KERN_DEBUG "%s: IO: %#4lx IRQ: %d DMA: %d\n",
	266	dev->name, dev->base_addr, dev->irq, dev->dma);
	267
1da177e4 LT	268	return 0;
	269	out:
	270	free_dma(dev->dma);
	271	out2:
	272	free_irq(dev->irq, dev);
	273	out3:
	274	tmsdev_term(dev);
	275	out4:
504ff16c JF	276	release_region(dev->base_addr, SK_ISA_IO_EXTENT);
504ff16c JF	277	out5:
1da177e4 LT	278	return err;
	279	}
	280
1da177e4 LT	281	/*
	282	* Reads MAC address from adapter RAM, which should've read it from
	283	* the onboard ROM.
	284	*
	285	* Calling this on a board that does not support it can be a very
	286	* dangerous thing. The Madge board, for instance, will lock your
	287	* machine hard when this is called. Luckily, its supported in a
	288	* separate driver. --ASF
	289	*/
	290	static void sk_isa_read_eeprom(struct net_device *dev)
	291	{
	292	int i;
	293
	294	/* Address: 0000:0000 */
	295	sk_isa_sifwritew(dev, 0, SIFADX);
	296	sk_isa_sifwritew(dev, 0, SIFADR);
	297
	298	/* Read six byte MAC address data */
	299	dev->addr_len = 6;
	300	for(i = 0; i < 6; i++)
	301	dev->dev_addr[i] = sk_isa_sifreadw(dev, SIFINC) >> 8;
	302	}
	303
	304	unsigned short sk_isa_setnselout_pins(struct net_device *dev)
	305	{
	306	return 0;
	307	}
	308
	309	static int sk_isa_open(struct net_device *dev)
	310	{
	311	struct net_local *tp = netdev_priv(dev);
	312	unsigned short val = 0;
	313	unsigned short oldval;
	314	int i;
	315
	316	val = 0;
	317	for(i = 0; irqlist[i] != 0; i++)
	318	{
	319	if(irqlist[i] == dev->irq)
	320	break;
	321	}
	322
	323	val \|= CYCLE_TIME << 2;
	324	val \|= i << 4;
	325	i = dev->dma - 5;
	326	val \|= i;
	327	if(tp->DataRate == SPEED_4)
	328	val \|= LINE_SPEED_BIT;
	329	else
	330	val &= ~LINE_SPEED_BIT;
	331	oldval = sk_isa_sifreadb(dev, POSREG);
	332	/* Leave cycle bits alone */
	333	oldval \|= 0xf3;
	334	val &= oldval;
	335	sk_isa_sifwriteb(dev, val, POSREG);
	336
	337	return tms380tr_open(dev);
	338	}
	339
1da177e4 LT	340	#define ISATR_MAX_ADAPTERS 3
	341
	342	static int io[ISATR_MAX_ADAPTERS];
	343	static int irq[ISATR_MAX_ADAPTERS];
	344	static int dma[ISATR_MAX_ADAPTERS];
	345
	346	MODULE_LICENSE("GPL");
	347
	348	module_param_array(io, int, NULL, 0);
	349	module_param_array(irq, int, NULL, 0);
	350	module_param_array(dma, int, NULL, 0);
	351
504ff16c	352	static struct platform_device *sk_isa_dev[ISATR_MAX_ADAPTERS];
1da177e4	353
3ae5eaec RK	354	static struct platform_driver sk_isa_driver = {
	355	.driver = {
	356	.name = "skisa",
	357	},
504ff16c JF	358	};
	359
	360	static int __init sk_isa_init(void)
1da177e4 LT	361	{
1da177e4 LT	362	struct net_device *dev;
504ff16c	363	struct platform_device *pdev;
1da177e4 LT	364	int i, num = 0, err = 0;
1da177e4 LT	365
3ae5eaec	366	err = platform_driver_register(&sk_isa_driver);
504ff16c JF	367	if (err)
	368	return err;
	369
1da177e4 LT	370	for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
	371	dev = alloc_trdev(sizeof(struct net_local));
	372	if (!dev)
	373	continue;
	374
	375	dev->base_addr = io[i];
	376	dev->irq = irq[i];
	377	dev->dma = dma[i];
504ff16c JF	378	pdev = platform_device_register_simple("skisa",
504ff16c JF	379	i, NULL, 0);
9d4df9e0 AM	380	if (IS_ERR(pdev)) {
	381	free_netdev(dev);
	382	continue;
	383	}
504ff16c	384	err = setup_card(dev, &pdev->dev);
1da177e4	385	if (!err) {
504ff16c	386	sk_isa_dev[i] = pdev;
3ae5eaec	387	platform_set_drvdata(sk_isa_dev[i], dev);
1da177e4 LT	388	++num;
1da177e4 LT	389	} else {
504ff16c	390	platform_device_unregister(pdev);
1da177e4 LT	391	free_netdev(dev);
	392	}
	393	}
	394
	395	printk(KERN_NOTICE "skisa.c: %d cards found.\n", num);
	396	/* Probe for cards. */
	397	if (num == 0) {
	398	printk(KERN_NOTICE "skisa.c: No cards found.\n");
9d4df9e0 AM	399	platform_driver_unregister(&sk_isa_driver);
9d4df9e0 AM	400	return -ENODEV;
1da177e4	401	}
9d4df9e0	402	return 0;
1da177e4 LT	403	}
1da177e4 LT	404
504ff16c	405	static void __exit sk_isa_cleanup(void)
1da177e4	406	{
504ff16c	407	struct net_device *dev;
1da177e4 LT	408	int i;
	409
	410	for (i = 0; i < ISATR_MAX_ADAPTERS ; i++) {
504ff16c	411	struct platform_device *pdev = sk_isa_dev[i];
1da177e4	412
504ff16c	413	if (!pdev)
1da177e4	414	continue;
3ae5eaec	415	dev = platform_get_drvdata(pdev);
1da177e4 LT	416	unregister_netdev(dev);
	417	release_region(dev->base_addr, SK_ISA_IO_EXTENT);
	418	free_irq(dev->irq, dev);
	419	free_dma(dev->dma);
	420	tmsdev_term(dev);
	421	free_netdev(dev);
3ae5eaec	422	platform_set_drvdata(pdev, NULL);
504ff16c	423	platform_device_unregister(pdev);
1da177e4	424	}
3ae5eaec	425	platform_driver_unregister(&sk_isa_driver);
1da177e4	426	}
1da177e4	427
504ff16c JF	428	module_init(sk_isa_init);
504ff16c JF	429	module_exit(sk_isa_cleanup);