drivers/net/pcmcia/com20020_cs.c - android_kernel_htc_msm8960 - Gitiles

 /*
  * 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");

 /*====================================================================*/

 static int com20020_config(struct pcmcia_device *link);
 static void com20020_release(struct pcmcia_device *link);

 static void com20020_detach(struct pcmcia_device *p_dev);

 /*====================================================================*/

 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.

 ======================================================================*/

 static int com20020_probe(struct pcmcia_device *p_dev)
 {
     com20020_dev_t *info;
     struct net_device *dev;
     struct arcnet_local *lp;

     DEBUG(0, "com20020_attach()\n");

     /* Create new network device */
     info = kzalloc(sizeof(struct com20020_dev_t), GFP_KERNEL);
     if (!info)
 	goto fail_alloc_info;

     dev = alloc_arcdev("");
     if (!dev)
 	goto fail_alloc_dev;

     lp = netdev_priv(dev);
     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;

     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;

     p_dev->irq.Instance = info->dev = dev;
     p_dev->priv = info;

     return com20020_config(p_dev);

 fail_alloc_dev:
     kfree(info);
 fail_alloc_info:
     return -ENOMEM;
 } /* 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.

 ======================================================================*/

 static void com20020_detach(struct pcmcia_device *link)
 {
     struct com20020_dev_t *info = link->priv;
     struct net_device *dev = info->dev;

     DEBUG(1,"detach...\n");

     DEBUG(0, "com20020_detach(0x%p)\n", link);

     if (link->dev_node) {
 	DEBUG(1,"unregister...\n");

 	unregister_netdev(dev);

 	/*
 	 * this is necessary because we register our IRQ separately
 	 * from card services.
 	 */
 	if (dev->irq)
 	    free_irq(dev->irq, dev);
     }

     com20020_release(link);

     /* 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)

 static int com20020_config(struct pcmcia_device *link)
 {
     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 = -ENODEV;
     if (!link->io.BasePort1)
     {
 	for (ioaddr = 0x100; ioaddr < 0x400; ioaddr += 0x10)
 	{
 	    link->io.BasePort1 = ioaddr;
 	    i = pcmcia_request_io(link, &link->io);
 	    if (i == 0)
 		break;
 	}
     }
     else
 	i = pcmcia_request_io(link, &link->io);

     if (i != 0)
     {
 	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);
     i = pcmcia_request_irq(link, &link->irq);
     if (i != 0)
     {
 	DEBUG(1,"arcnet: requestIRQ failed totally!\n");
 	goto failed;
     }

     dev->irq = link->irq.AssignedIRQ;

     CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));

     if (com20020_check(dev))
     {
 	regdump(dev);
 	goto failed;
     }

     lp = netdev_priv(dev);
     lp->card_name = "PCMCIA COM20020";
     lp->card_flags = ARC_CAN_10MBIT; /* pretend all of them can 10Mbit */

     link->dev_node = &info->node;
     SET_NETDEV_DEV(dev, &handle_to_dev(link));

     i = com20020_found(dev, 0);	/* calls register_netdev */

     if (i != 0) {
 	DEBUG(1,KERN_NOTICE "com20020_cs: com20020_found() failed\n");
 	link->dev_node = NULL;
 	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);
     return 0;

 cs_failed:
     cs_error(link, last_fn, last_ret);
 failed:
     DEBUG(1,"com20020_config failed...\n");
     com20020_release(link);
     return -ENODEV;
 } /* 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.

 ======================================================================*/

 static void com20020_release(struct pcmcia_device *link)
 {
 	DEBUG(0, "com20020_release(0x%p)\n", link);
 	pcmcia_disable_device(link);
 }

 static int com20020_suspend(struct pcmcia_device *link)
 {
 	com20020_dev_t *info = link->priv;
 	struct net_device *dev = info->dev;

 	if (link->open)
 		netif_device_detach(dev);

 	return 0;
 }

 static int com20020_resume(struct pcmcia_device *link)
 {
 	com20020_dev_t *info = link->priv;
 	struct net_device *dev = info->dev;

 	if (link->open) {
 		int ioaddr = dev->base_addr;
 		struct arcnet_local *lp = netdev_priv(dev);
 		ARCRESET;
 	}

 	return 0;
 }

 static struct pcmcia_device_id com20020_ids[] = {
 	PCMCIA_DEVICE_PROD_ID12("Contemporary Control Systems, Inc.",
 			"PCM20 Arcnet Adapter", 0x59991666, 0x95dfffaf),
 	PCMCIA_DEVICE_PROD_ID12("SoHard AG",
 			"SH ARC PCMCIA", 0xf8991729, 0x69dff0c7),
 	PCMCIA_DEVICE_NULL
 };
 MODULE_DEVICE_TABLE(pcmcia, com20020_ids);

 static struct pcmcia_driver com20020_cs_driver = {
 	.owner		= THIS_MODULE,
 	.drv		= {
 		.name	= "com20020_cs",
 	},
 	.probe		= com20020_probe,
 	.remove		= com20020_detach,
 	.id_table	= com20020_ids,
 	.suspend	= com20020_suspend,
 	.resume		= com20020_resume,
 };

 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);
	/*
	* 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");

	/====================================================================/

	static int com20020_config(struct pcmcia_device *link);
	static void com20020_release(struct pcmcia_device *link);

	static void com20020_detach(struct pcmcia_device *p_dev);

	/====================================================================/

	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.

	======================================================================*/

	static int com20020_probe(struct pcmcia_device *p_dev)
	{
	com20020_dev_t *info;
	struct net_device *dev;
	struct arcnet_local *lp;

	DEBUG(0, "com20020_attach()\n");

	/* Create new network device */
	info = kzalloc(sizeof(struct com20020_dev_t), GFP_KERNEL);
	if (!info)
	goto fail_alloc_info;

	dev = alloc_arcdev("");
	if (!dev)
	goto fail_alloc_dev;

	lp = netdev_priv(dev);
	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;

	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;

	p_dev->irq.Instance = info->dev = dev;
	p_dev->priv = info;

	return com20020_config(p_dev);

	fail_alloc_dev:
	kfree(info);
	fail_alloc_info:
	return -ENOMEM;
	} /* 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.

	======================================================================*/

	static void com20020_detach(struct pcmcia_device *link)
	{
	struct com20020_dev_t *info = link->priv;
	struct net_device *dev = info->dev;

	DEBUG(1,"detach...\n");

	DEBUG(0, "com20020_detach(0x%p)\n", link);

	if (link->dev_node) {
	DEBUG(1,"unregister...\n");

	unregister_netdev(dev);

	/*
	* this is necessary because we register our IRQ separately
	* from card services.
	*/
	if (dev->irq)
	free_irq(dev->irq, dev);
	}

	com20020_release(link);

	/* 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)

	static int com20020_config(struct pcmcia_device *link)
	{
	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 = -ENODEV;
	if (!link->io.BasePort1)
	{
	for (ioaddr = 0x100; ioaddr < 0x400; ioaddr += 0x10)
	{
	link->io.BasePort1 = ioaddr;
	i = pcmcia_request_io(link, &link->io);
	if (i == 0)
	break;
	}
	}
	else
	i = pcmcia_request_io(link, &link->io);

	if (i != 0)
	{
	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);
	i = pcmcia_request_irq(link, &link->irq);
	if (i != 0)
	{
	DEBUG(1,"arcnet: requestIRQ failed totally!\n");
	goto failed;
	}

	dev->irq = link->irq.AssignedIRQ;

	CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));

	if (com20020_check(dev))
	{
	regdump(dev);
	goto failed;
	}

	lp = netdev_priv(dev);
	lp->card_name = "PCMCIA COM20020";
	lp->card_flags = ARC_CAN_10MBIT; /* pretend all of them can 10Mbit */

	link->dev_node = &info->node;
	SET_NETDEV_DEV(dev, &handle_to_dev(link));

	i = com20020_found(dev, 0); /* calls register_netdev */

	if (i != 0) {
	DEBUG(1,KERN_NOTICE "com20020_cs: com20020_found() failed\n");
	link->dev_node = NULL;
	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);
	return 0;

	cs_failed:
	cs_error(link, last_fn, last_ret);
	failed:
	DEBUG(1,"com20020_config failed...\n");
	com20020_release(link);
	return -ENODEV;
	} /* 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.

	======================================================================*/

	static void com20020_release(struct pcmcia_device *link)
	{
	DEBUG(0, "com20020_release(0x%p)\n", link);
	pcmcia_disable_device(link);
	}

	static int com20020_suspend(struct pcmcia_device *link)
	{
	com20020_dev_t *info = link->priv;
	struct net_device *dev = info->dev;

	if (link->open)
	netif_device_detach(dev);

	return 0;
	}

	static int com20020_resume(struct pcmcia_device *link)
	{
	com20020_dev_t *info = link->priv;
	struct net_device *dev = info->dev;

	if (link->open) {
	int ioaddr = dev->base_addr;
	struct arcnet_local *lp = netdev_priv(dev);
	ARCRESET;
	}

	return 0;
	}

	static struct pcmcia_device_id com20020_ids[] = {
	PCMCIA_DEVICE_PROD_ID12("Contemporary Control Systems, Inc.",
	"PCM20 Arcnet Adapter", 0x59991666, 0x95dfffaf),
	PCMCIA_DEVICE_PROD_ID12("SoHard AG",
	"SH ARC PCMCIA", 0xf8991729, 0x69dff0c7),
	PCMCIA_DEVICE_NULL
	};
	MODULE_DEVICE_TABLE(pcmcia, com20020_ids);

	static struct pcmcia_driver com20020_cs_driver = {
	.owner = THIS_MODULE,
	.drv = {
	.name = "com20020_cs",
	},
	.probe = com20020_probe,
	.remove = com20020_detach,
	.id_table = com20020_ids,
	.suspend = com20020_suspend,
	.resume = com20020_resume,
	};

	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);