2005-04-17 00:20:36 +02:00
|
|
|
/*
|
|
|
|
* Linux ARCnet driver - COM20020 PCMCIA support
|
|
|
|
*
|
|
|
|
* Written 1994-1999 by Avery Pennarun,
|
|
|
|
* based on an ISA version by David Woodhouse.
|
|
|
|
* Derived from ibmtr_cs.c by Steve Kipisz (pcmcia-cs 3.1.4)
|
|
|
|
* which was derived from pcnet_cs.c by David Hinds.
|
|
|
|
* Some additional portions derived from skeleton.c by Donald Becker.
|
|
|
|
*
|
|
|
|
* Special thanks to Contemporary Controls, Inc. (www.ccontrols.com)
|
|
|
|
* for sponsoring the further development of this driver.
|
|
|
|
*
|
|
|
|
* **********************
|
|
|
|
*
|
|
|
|
* The original copyright of skeleton.c was as follows:
|
|
|
|
*
|
|
|
|
* skeleton.c Written 1993 by Donald Becker.
|
|
|
|
* Copyright 1993 United States Government as represented by the
|
|
|
|
* Director, National Security Agency. This software may only be used
|
|
|
|
* and distributed according to the terms of the GNU General Public License as
|
|
|
|
* modified by SRC, incorporated herein by reference.
|
|
|
|
*
|
|
|
|
* **********************
|
|
|
|
* Changes:
|
|
|
|
* Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 08/08/2000
|
|
|
|
* - reorganize kmallocs in com20020_attach, checking all for failure
|
|
|
|
* and releasing the previous allocations if one fails
|
|
|
|
* **********************
|
|
|
|
*
|
|
|
|
* For more details, see drivers/net/arcnet.c
|
|
|
|
*
|
|
|
|
* **********************
|
|
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/ptrace.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/timer.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/netdevice.h>
|
|
|
|
#include <linux/arcdevice.h>
|
|
|
|
#include <linux/com20020.h>
|
|
|
|
|
|
|
|
#include <pcmcia/cs_types.h>
|
|
|
|
#include <pcmcia/cs.h>
|
|
|
|
#include <pcmcia/cistpl.h>
|
|
|
|
#include <pcmcia/ds.h>
|
|
|
|
|
|
|
|
#include <asm/io.h>
|
|
|
|
#include <asm/system.h>
|
|
|
|
|
|
|
|
#define VERSION "arcnet: COM20020 PCMCIA support loaded.\n"
|
|
|
|
|
|
|
|
#ifdef PCMCIA_DEBUG
|
|
|
|
|
|
|
|
static int pc_debug = PCMCIA_DEBUG;
|
|
|
|
module_param(pc_debug, int, 0);
|
|
|
|
#define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
|
|
|
|
|
|
|
|
static void regdump(struct net_device *dev)
|
|
|
|
{
|
|
|
|
int ioaddr = dev->base_addr;
|
|
|
|
int count;
|
|
|
|
|
|
|
|
printk("com20020 register dump:\n");
|
|
|
|
for (count = ioaddr; count < ioaddr + 16; count++)
|
|
|
|
{
|
|
|
|
if (!(count % 16))
|
|
|
|
printk("\n%04X: ", count);
|
|
|
|
printk("%02X ", inb(count));
|
|
|
|
}
|
|
|
|
printk("\n");
|
|
|
|
|
|
|
|
printk("buffer0 dump:\n");
|
|
|
|
/* set up the address register */
|
|
|
|
count = 0;
|
|
|
|
outb((count >> 8) | RDDATAflag | AUTOINCflag, _ADDR_HI);
|
|
|
|
outb(count & 0xff, _ADDR_LO);
|
|
|
|
|
|
|
|
for (count = 0; count < 256+32; count++)
|
|
|
|
{
|
|
|
|
if (!(count % 16))
|
|
|
|
printk("\n%04X: ", count);
|
|
|
|
|
|
|
|
/* copy the data */
|
|
|
|
printk("%02X ", inb(_MEMDATA));
|
|
|
|
}
|
|
|
|
printk("\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
#define DEBUG(n, args...) do { } while (0)
|
|
|
|
static inline void regdump(struct net_device *dev) { }
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
/*====================================================================*/
|
|
|
|
|
|
|
|
/* Parameters that can be set with 'insmod' */
|
|
|
|
|
|
|
|
static int node;
|
|
|
|
static int timeout = 3;
|
|
|
|
static int backplane;
|
|
|
|
static int clockp;
|
|
|
|
static int clockm;
|
|
|
|
|
|
|
|
module_param(node, int, 0);
|
|
|
|
module_param(timeout, int, 0);
|
|
|
|
module_param(backplane, int, 0);
|
|
|
|
module_param(clockp, int, 0);
|
|
|
|
module_param(clockm, int, 0);
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
|
|
/*====================================================================*/
|
|
|
|
|
2006-03-31 17:26:06 +02:00
|
|
|
static int com20020_config(struct pcmcia_device *link);
|
2006-03-31 17:21:06 +02:00
|
|
|
static void com20020_release(struct pcmcia_device *link);
|
2005-04-17 00:20:36 +02:00
|
|
|
|
2005-11-14 21:23:14 +01:00
|
|
|
static void com20020_detach(struct pcmcia_device *p_dev);
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
/*====================================================================*/
|
|
|
|
|
|
|
|
typedef struct com20020_dev_t {
|
|
|
|
struct net_device *dev;
|
|
|
|
dev_node_t node;
|
|
|
|
} com20020_dev_t;
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
com20020_attach() creates an "instance" of the driver, allocating
|
|
|
|
local data structures for one device. The device is registered
|
|
|
|
with Card Services.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2006-03-31 17:26:06 +02:00
|
|
|
static int com20020_probe(struct pcmcia_device *p_dev)
|
2005-04-17 00:20:36 +02:00
|
|
|
{
|
|
|
|
com20020_dev_t *info;
|
|
|
|
struct net_device *dev;
|
|
|
|
struct arcnet_local *lp;
|
2005-11-14 21:25:51 +01:00
|
|
|
|
2005-04-17 00:20:36 +02:00
|
|
|
DEBUG(0, "com20020_attach()\n");
|
|
|
|
|
|
|
|
/* Create new network device */
|
some kmalloc/memset ->kzalloc (tree wide)
Transform some calls to kmalloc/memset to a single kzalloc (or kcalloc).
Here is a short excerpt of the semantic patch performing
this transformation:
@@
type T2;
expression x;
identifier f,fld;
expression E;
expression E1,E2;
expression e1,e2,e3,y;
statement S;
@@
x =
- kmalloc
+ kzalloc
(E1,E2)
... when != \(x->fld=E;\|y=f(...,x,...);\|f(...,x,...);\|x=E;\|while(...) S\|for(e1;e2;e3) S\)
- memset((T2)x,0,E1);
@@
expression E1,E2,E3;
@@
- kzalloc(E1 * E2,E3)
+ kcalloc(E1,E2,E3)
[akpm@linux-foundation.org: get kcalloc args the right way around]
Signed-off-by: Yoann Padioleau <padator@wanadoo.fr>
Cc: Richard Henderson <rth@twiddle.net>
Cc: Ivan Kokshaysky <ink@jurassic.park.msu.ru>
Acked-by: Russell King <rmk@arm.linux.org.uk>
Cc: Bryan Wu <bryan.wu@analog.com>
Acked-by: Jiri Slaby <jirislaby@gmail.com>
Cc: Dave Airlie <airlied@linux.ie>
Acked-by: Roland Dreier <rolandd@cisco.com>
Cc: Jiri Kosina <jkosina@suse.cz>
Acked-by: Dmitry Torokhov <dtor@mail.ru>
Cc: Benjamin Herrenschmidt <benh@kernel.crashing.org>
Acked-by: Mauro Carvalho Chehab <mchehab@infradead.org>
Acked-by: Pierre Ossman <drzeus-list@drzeus.cx>
Cc: Jeff Garzik <jeff@garzik.org>
Cc: "David S. Miller" <davem@davemloft.net>
Acked-by: Greg KH <greg@kroah.com>
Cc: James Bottomley <James.Bottomley@steeleye.com>
Cc: "Antonino A. Daplas" <adaplas@pol.net>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
2007-07-19 10:49:03 +02:00
|
|
|
info = kzalloc(sizeof(struct com20020_dev_t), GFP_KERNEL);
|
2005-04-17 00:20:36 +02:00
|
|
|
if (!info)
|
|
|
|
goto fail_alloc_info;
|
|
|
|
|
|
|
|
dev = alloc_arcdev("");
|
|
|
|
if (!dev)
|
|
|
|
goto fail_alloc_dev;
|
|
|
|
|
|
|
|
lp = dev->priv;
|
|
|
|
lp->timeout = timeout;
|
|
|
|
lp->backplane = backplane;
|
|
|
|
lp->clockp = clockp;
|
|
|
|
lp->clockm = clockm & 3;
|
|
|
|
lp->hw.owner = THIS_MODULE;
|
|
|
|
|
|
|
|
/* fill in our module parameters as defaults */
|
|
|
|
dev->dev_addr[0] = node;
|
|
|
|
|
2006-03-05 10:45:09 +01:00
|
|
|
p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
|
|
|
|
p_dev->io.NumPorts1 = 16;
|
|
|
|
p_dev->io.IOAddrLines = 16;
|
|
|
|
p_dev->irq.Attributes = IRQ_TYPE_EXCLUSIVE;
|
|
|
|
p_dev->irq.IRQInfo1 = IRQ_LEVEL_ID;
|
|
|
|
p_dev->conf.Attributes = CONF_ENABLE_IRQ;
|
|
|
|
p_dev->conf.IntType = INT_MEMORY_AND_IO;
|
2005-04-17 00:20:36 +02:00
|
|
|
|
2006-03-05 10:45:09 +01:00
|
|
|
p_dev->irq.Instance = info->dev = dev;
|
|
|
|
p_dev->priv = info;
|
2005-04-17 00:20:36 +02:00
|
|
|
|
2006-03-31 17:26:06 +02:00
|
|
|
return com20020_config(p_dev);
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
fail_alloc_dev:
|
|
|
|
kfree(info);
|
|
|
|
fail_alloc_info:
|
2005-11-14 21:25:51 +01:00
|
|
|
return -ENOMEM;
|
2005-04-17 00:20:36 +02:00
|
|
|
} /* com20020_attach */
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
This deletes a driver "instance". The device is de-registered
|
|
|
|
with Card Services. If it has been released, all local data
|
|
|
|
structures are freed. Otherwise, the structures will be freed
|
|
|
|
when the device is released.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2006-03-31 17:21:06 +02:00
|
|
|
static void com20020_detach(struct pcmcia_device *link)
|
2005-04-17 00:20:36 +02:00
|
|
|
{
|
|
|
|
struct com20020_dev_t *info = link->priv;
|
2005-11-14 21:25:35 +01:00
|
|
|
struct net_device *dev = info->dev;
|
|
|
|
|
2005-04-17 00:20:36 +02:00
|
|
|
DEBUG(1,"detach...\n");
|
|
|
|
|
|
|
|
DEBUG(0, "com20020_detach(0x%p)\n", link);
|
|
|
|
|
2006-03-05 10:45:09 +01:00
|
|
|
if (link->dev_node) {
|
2005-04-17 00:20:36 +02:00
|
|
|
DEBUG(1,"unregister...\n");
|
|
|
|
|
|
|
|
unregister_netdev(dev);
|
2005-11-14 21:25:35 +01:00
|
|
|
|
2005-04-17 00:20:36 +02:00
|
|
|
/*
|
|
|
|
* this is necessary because we register our IRQ separately
|
|
|
|
* from card services.
|
|
|
|
*/
|
|
|
|
if (dev->irq)
|
|
|
|
free_irq(dev->irq, dev);
|
|
|
|
}
|
|
|
|
|
2006-03-02 00:09:29 +01:00
|
|
|
com20020_release(link);
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
/* Unlink device structure, free bits */
|
|
|
|
DEBUG(1,"unlinking...\n");
|
|
|
|
if (link->priv)
|
|
|
|
{
|
|
|
|
dev = info->dev;
|
|
|
|
if (dev)
|
|
|
|
{
|
|
|
|
DEBUG(1,"kfree...\n");
|
|
|
|
free_netdev(dev);
|
|
|
|
}
|
|
|
|
DEBUG(1,"kfree2...\n");
|
|
|
|
kfree(info);
|
|
|
|
}
|
|
|
|
|
|
|
|
} /* com20020_detach */
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
com20020_config() is scheduled to run after a CARD_INSERTION event
|
|
|
|
is received, to configure the PCMCIA socket, and to make the
|
|
|
|
device available to the system.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
|
|
|
#define CS_CHECK(fn, ret) \
|
|
|
|
do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
|
|
|
|
|
2006-03-31 17:26:06 +02:00
|
|
|
static int com20020_config(struct pcmcia_device *link)
|
2005-04-17 00:20:36 +02:00
|
|
|
{
|
|
|
|
struct arcnet_local *lp;
|
|
|
|
com20020_dev_t *info;
|
|
|
|
struct net_device *dev;
|
|
|
|
int i, last_ret, last_fn;
|
|
|
|
int ioaddr;
|
|
|
|
|
|
|
|
info = link->priv;
|
|
|
|
dev = info->dev;
|
|
|
|
|
|
|
|
DEBUG(1,"config...\n");
|
|
|
|
|
|
|
|
DEBUG(0, "com20020_config(0x%p)\n", link);
|
|
|
|
|
|
|
|
DEBUG(1,"arcnet: baseport1 is %Xh\n", link->io.BasePort1);
|
|
|
|
i = !CS_SUCCESS;
|
|
|
|
if (!link->io.BasePort1)
|
|
|
|
{
|
|
|
|
for (ioaddr = 0x100; ioaddr < 0x400; ioaddr += 0x10)
|
|
|
|
{
|
|
|
|
link->io.BasePort1 = ioaddr;
|
2006-03-31 17:21:06 +02:00
|
|
|
i = pcmcia_request_io(link, &link->io);
|
2005-04-17 00:20:36 +02:00
|
|
|
if (i == CS_SUCCESS)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else
|
2006-03-31 17:21:06 +02:00
|
|
|
i = pcmcia_request_io(link, &link->io);
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
if (i != CS_SUCCESS)
|
|
|
|
{
|
|
|
|
DEBUG(1,"arcnet: requestIO failed totally!\n");
|
|
|
|
goto failed;
|
|
|
|
}
|
|
|
|
|
|
|
|
ioaddr = dev->base_addr = link->io.BasePort1;
|
|
|
|
DEBUG(1,"arcnet: got ioaddr %Xh\n", ioaddr);
|
|
|
|
|
|
|
|
DEBUG(1,"arcnet: request IRQ %d (%Xh/%Xh)\n",
|
|
|
|
link->irq.AssignedIRQ,
|
|
|
|
link->irq.IRQInfo1, link->irq.IRQInfo2);
|
2006-03-31 17:21:06 +02:00
|
|
|
i = pcmcia_request_irq(link, &link->irq);
|
2005-04-17 00:20:36 +02:00
|
|
|
if (i != CS_SUCCESS)
|
|
|
|
{
|
|
|
|
DEBUG(1,"arcnet: requestIRQ failed totally!\n");
|
|
|
|
goto failed;
|
|
|
|
}
|
|
|
|
|
|
|
|
dev->irq = link->irq.AssignedIRQ;
|
|
|
|
|
2006-03-31 17:21:06 +02:00
|
|
|
CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
if (com20020_check(dev))
|
|
|
|
{
|
|
|
|
regdump(dev);
|
|
|
|
goto failed;
|
|
|
|
}
|
|
|
|
|
|
|
|
lp = dev->priv;
|
|
|
|
lp->card_name = "PCMCIA COM20020";
|
|
|
|
lp->card_flags = ARC_CAN_10MBIT; /* pretend all of them can 10Mbit */
|
|
|
|
|
2006-03-05 10:45:09 +01:00
|
|
|
link->dev_node = &info->node;
|
2006-03-31 17:21:06 +02:00
|
|
|
SET_NETDEV_DEV(dev, &handle_to_dev(link));
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
i = com20020_found(dev, 0); /* calls register_netdev */
|
|
|
|
|
|
|
|
if (i != 0) {
|
|
|
|
DEBUG(1,KERN_NOTICE "com20020_cs: com20020_found() failed\n");
|
2006-03-05 10:45:09 +01:00
|
|
|
link->dev_node = NULL;
|
2005-04-17 00:20:36 +02:00
|
|
|
goto failed;
|
|
|
|
}
|
|
|
|
|
|
|
|
strcpy(info->node.dev_name, dev->name);
|
|
|
|
|
|
|
|
DEBUG(1,KERN_INFO "%s: port %#3lx, irq %d\n",
|
|
|
|
dev->name, dev->base_addr, dev->irq);
|
2006-03-31 17:26:06 +02:00
|
|
|
return 0;
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
cs_failed:
|
2006-03-31 17:21:06 +02:00
|
|
|
cs_error(link, last_fn, last_ret);
|
2005-04-17 00:20:36 +02:00
|
|
|
failed:
|
|
|
|
DEBUG(1,"com20020_config failed...\n");
|
|
|
|
com20020_release(link);
|
2006-03-31 17:26:06 +02:00
|
|
|
return -ENODEV;
|
2005-04-17 00:20:36 +02:00
|
|
|
} /* com20020_config */
|
|
|
|
|
|
|
|
/*======================================================================
|
|
|
|
|
|
|
|
After a card is removed, com20020_release() will unregister the net
|
|
|
|
device, and release the PCMCIA configuration. If the device is
|
|
|
|
still open, this will be postponed until it is closed.
|
|
|
|
|
|
|
|
======================================================================*/
|
|
|
|
|
2006-03-31 17:21:06 +02:00
|
|
|
static void com20020_release(struct pcmcia_device *link)
|
2005-04-17 00:20:36 +02:00
|
|
|
{
|
2006-01-15 09:32:39 +01:00
|
|
|
DEBUG(0, "com20020_release(0x%p)\n", link);
|
2006-03-31 17:21:06 +02:00
|
|
|
pcmcia_disable_device(link);
|
2005-04-17 00:20:36 +02:00
|
|
|
}
|
|
|
|
|
2006-03-31 17:21:06 +02:00
|
|
|
static int com20020_suspend(struct pcmcia_device *link)
|
2005-11-14 21:21:18 +01:00
|
|
|
{
|
|
|
|
com20020_dev_t *info = link->priv;
|
|
|
|
struct net_device *dev = info->dev;
|
|
|
|
|
2006-03-02 00:09:29 +01:00
|
|
|
if (link->open)
|
2006-03-02 00:02:33 +01:00
|
|
|
netif_device_detach(dev);
|
2005-11-14 21:21:18 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2006-03-31 17:21:06 +02:00
|
|
|
static int com20020_resume(struct pcmcia_device *link)
|
2005-11-14 21:21:18 +01:00
|
|
|
{
|
|
|
|
com20020_dev_t *info = link->priv;
|
|
|
|
struct net_device *dev = info->dev;
|
|
|
|
|
2006-03-02 00:09:29 +01:00
|
|
|
if (link->open) {
|
2006-03-02 00:02:33 +01:00
|
|
|
int ioaddr = dev->base_addr;
|
|
|
|
struct arcnet_local *lp = dev->priv;
|
|
|
|
ARCRESET;
|
|
|
|
}
|
2005-11-14 21:21:18 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2005-06-28 01:28:38 +02:00
|
|
|
static struct pcmcia_device_id com20020_ids[] = {
|
2006-06-25 10:56:24 +02:00
|
|
|
PCMCIA_DEVICE_PROD_ID12("Contemporary Control Systems, Inc.",
|
|
|
|
"PCM20 Arcnet Adapter", 0x59991666, 0x95dfffaf),
|
|
|
|
PCMCIA_DEVICE_PROD_ID12("SoHard AG",
|
|
|
|
"SH ARC PCMCIA", 0xf8991729, 0x69dff0c7),
|
2005-06-28 01:28:38 +02:00
|
|
|
PCMCIA_DEVICE_NULL
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(pcmcia, com20020_ids);
|
2005-04-17 00:20:36 +02:00
|
|
|
|
|
|
|
static struct pcmcia_driver com20020_cs_driver = {
|
|
|
|
.owner = THIS_MODULE,
|
|
|
|
.drv = {
|
|
|
|
.name = "com20020_cs",
|
|
|
|
},
|
2006-03-31 17:26:06 +02:00
|
|
|
.probe = com20020_probe,
|
2005-11-14 21:23:14 +01:00
|
|
|
.remove = com20020_detach,
|
2005-06-28 01:28:38 +02:00
|
|
|
.id_table = com20020_ids,
|
2005-11-14 21:21:18 +01:00
|
|
|
.suspend = com20020_suspend,
|
|
|
|
.resume = com20020_resume,
|
2005-04-17 00:20:36 +02:00
|
|
|
};
|
|
|
|
|
|
|
|
static int __init init_com20020_cs(void)
|
|
|
|
{
|
|
|
|
return pcmcia_register_driver(&com20020_cs_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit exit_com20020_cs(void)
|
|
|
|
{
|
|
|
|
pcmcia_unregister_driver(&com20020_cs_driver);
|
|
|
|
}
|
|
|
|
|
|
|
|
module_init(init_com20020_cs);
|
|
|
|
module_exit(exit_com20020_cs);
|