brintos

brintos / linux-shallow public Read only

0
0
Text · 7.6 KiB · 75f08aa Raw
331 lines · c
1/*2 * Linux ARCnet driver - COM20020 PCMCIA support3 *4 * Written 1994-1999 by Avery Pennarun,5 *    based on an ISA version by David Woodhouse.6 * Derived from ibmtr_cs.c by Steve Kipisz (pcmcia-cs 3.1.4)7 *    which was derived from pcnet_cs.c by David Hinds.8 * Some additional portions derived from skeleton.c by Donald Becker.9 *10 * Special thanks to Contemporary Controls, Inc. (www.ccontrols.com)11 *  for sponsoring the further development of this driver.12 *13 * **********************14 *15 * The original copyright of skeleton.c was as follows:16 *17 * skeleton.c Written 1993 by Donald Becker.18 * Copyright 1993 United States Government as represented by the19 * Director, National Security Agency.  This software may only be used20 * and distributed according to the terms of the GNU General Public License as21 * modified by SRC, incorporated herein by reference.22 *23 * **********************24 * Changes:25 * Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 08/08/200026 * - reorganize kmallocs in com20020_attach, checking all for failure27 *   and releasing the previous allocations if one fails28 * **********************29 *30 * For more details, see drivers/net/arcnet.c31 *32 * **********************33 */34 35#define pr_fmt(fmt) "arcnet:" KBUILD_MODNAME ": " fmt36 37#include <linux/kernel.h>38#include <linux/ptrace.h>39#include <linux/slab.h>40#include <linux/string.h>41#include <linux/timer.h>42#include <linux/delay.h>43#include <linux/module.h>44#include <linux/netdevice.h>45#include <linux/io.h>46#include <pcmcia/cistpl.h>47#include <pcmcia/ds.h>48 49#include "arcdevice.h"50#include "com20020.h"51 52static void regdump(struct net_device *dev)53{54#ifdef DEBUG55	int ioaddr = dev->base_addr;56	int count;57 58	netdev_dbg(dev, "register dump:\n");59	for (count = 0; count < 16; count++) {60		if (!(count % 16))61			pr_cont("%04X:", ioaddr + count);62		pr_cont(" %02X", arcnet_inb(ioaddr, count));63	}64	pr_cont("\n");65 66	netdev_dbg(dev, "buffer0 dump:\n");67	/* set up the address register */68	count = 0;69	arcnet_outb((count >> 8) | RDDATAflag | AUTOINCflag,70		    ioaddr, COM20020_REG_W_ADDR_HI);71	arcnet_outb(count & 0xff, ioaddr, COM20020_REG_W_ADDR_LO);72 73	for (count = 0; count < 256 + 32; count++) {74		if (!(count % 16))75			pr_cont("%04X:", count);76 77		/* copy the data */78		pr_cont(" %02X", arcnet_inb(ioaddr, COM20020_REG_RW_MEMDATA));79	}80	pr_cont("\n");81#endif82}83 84/*====================================================================*/85 86/* Parameters that can be set with 'insmod' */87 88static int node;89static int timeout = 3;90static int backplane;91static int clockp;92static int clockm;93 94module_param(node, int, 0);95module_param(timeout, int, 0);96module_param(backplane, int, 0);97module_param(clockp, int, 0);98module_param(clockm, int, 0);99 100MODULE_DESCRIPTION("ARCnet COM20020 chipset PCMCIA driver");101MODULE_LICENSE("GPL");102 103/*====================================================================*/104 105static int com20020_config(struct pcmcia_device *link);106static void com20020_release(struct pcmcia_device *link);107 108static void com20020_detach(struct pcmcia_device *p_dev);109 110/*====================================================================*/111 112static int com20020_probe(struct pcmcia_device *p_dev)113{114	struct com20020_dev *info;115	struct net_device *dev;116	struct arcnet_local *lp;117	int ret = -ENOMEM;118 119	dev_dbg(&p_dev->dev, "com20020_attach()\n");120 121	/* Create new network device */122	info = kzalloc(sizeof(*info), GFP_KERNEL);123	if (!info)124		goto fail_alloc_info;125 126	dev = alloc_arcdev("");127	if (!dev)128		goto fail_alloc_dev;129 130	lp = netdev_priv(dev);131	lp->timeout = timeout;132	lp->backplane = backplane;133	lp->clockp = clockp;134	lp->clockm = clockm & 3;135	lp->hw.owner = THIS_MODULE;136 137	/* fill in our module parameters as defaults */138	arcnet_set_addr(dev, node);139 140	p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;141	p_dev->resource[0]->end = 16;142	p_dev->config_flags |= CONF_ENABLE_IRQ;143 144	info->dev = dev;145	p_dev->priv = info;146 147	ret = com20020_config(p_dev);148	if (ret)149		goto fail_config;150 151	return 0;152 153fail_config:154	free_arcdev(dev);155fail_alloc_dev:156	kfree(info);157fail_alloc_info:158	return ret;159} /* com20020_attach */160 161static void com20020_detach(struct pcmcia_device *link)162{163	struct com20020_dev *info = link->priv;164	struct net_device *dev = info->dev;165 166	dev_dbg(&link->dev, "detach...\n");167 168	dev_dbg(&link->dev, "com20020_detach\n");169 170	dev_dbg(&link->dev, "unregister...\n");171 172	unregister_netdev(dev);173 174	/* this is necessary because we register our IRQ separately175	 * from card services.176	 */177	if (dev->irq)178		free_irq(dev->irq, dev);179 180	com20020_release(link);181 182	/* Unlink device structure, free bits */183	dev_dbg(&link->dev, "unlinking...\n");184	if (link->priv) {185		dev = info->dev;186		if (dev) {187			dev_dbg(&link->dev, "kfree...\n");188			free_arcdev(dev);189		}190		dev_dbg(&link->dev, "kfree2...\n");191		kfree(info);192	}193 194} /* com20020_detach */195 196static int com20020_config(struct pcmcia_device *link)197{198	struct arcnet_local *lp;199	struct com20020_dev *info;200	struct net_device *dev;201	int i, ret;202	int ioaddr;203 204	info = link->priv;205	dev = info->dev;206 207	dev_dbg(&link->dev, "config...\n");208 209	dev_dbg(&link->dev, "com20020_config\n");210 211	dev_dbg(&link->dev, "baseport1 is %Xh\n",212		(unsigned int)link->resource[0]->start);213 214	i = -ENODEV;215	link->io_lines = 16;216 217	if (!link->resource[0]->start) {218		for (ioaddr = 0x100; ioaddr < 0x400; ioaddr += 0x10) {219			link->resource[0]->start = ioaddr;220			i = pcmcia_request_io(link);221			if (i == 0)222				break;223		}224	} else {225		i = pcmcia_request_io(link);226	}227 228	if (i != 0) {229		dev_dbg(&link->dev, "requestIO failed totally!\n");230		goto failed;231	}232 233	ioaddr = dev->base_addr = link->resource[0]->start;234	dev_dbg(&link->dev, "got ioaddr %Xh\n", ioaddr);235 236	dev_dbg(&link->dev, "request IRQ %d\n",237		link->irq);238	if (!link->irq) {239		dev_dbg(&link->dev, "requestIRQ failed totally!\n");240		goto failed;241	}242 243	dev->irq = link->irq;244 245	ret = pcmcia_enable_device(link);246	if (ret)247		goto failed;248 249	if (com20020_check(dev)) {250		regdump(dev);251		goto failed;252	}253 254	lp = netdev_priv(dev);255	lp->card_name = "PCMCIA COM20020";256	lp->card_flags = ARC_CAN_10MBIT; /* pretend all of them can 10Mbit */257 258	SET_NETDEV_DEV(dev, &link->dev);259 260	i = com20020_found(dev, 0);	/* calls register_netdev */261 262	if (i != 0) {263		dev_notice(&link->dev,264			   "com20020_found() failed\n");265		goto failed;266	}267 268	netdev_dbg(dev, "port %#3lx, irq %d\n",269		   dev->base_addr, dev->irq);270	return 0;271 272failed:273	dev_dbg(&link->dev, "com20020_config failed...\n");274	com20020_release(link);275	return -ENODEV;276} /* com20020_config */277 278static void com20020_release(struct pcmcia_device *link)279{280	dev_dbg(&link->dev, "com20020_release\n");281	pcmcia_disable_device(link);282}283 284static int com20020_suspend(struct pcmcia_device *link)285{286	struct com20020_dev *info = link->priv;287	struct net_device *dev = info->dev;288 289	if (link->open)290		netif_device_detach(dev);291 292	return 0;293}294 295static int com20020_resume(struct pcmcia_device *link)296{297	struct com20020_dev *info = link->priv;298	struct net_device *dev = info->dev;299 300	if (link->open) {301		int ioaddr = dev->base_addr;302		struct arcnet_local *lp = netdev_priv(dev);303 304		arcnet_outb(lp->config | 0x80, ioaddr, COM20020_REG_W_CONFIG);305		udelay(5);306		arcnet_outb(lp->config, ioaddr, COM20020_REG_W_CONFIG);307	}308 309	return 0;310}311 312static const struct pcmcia_device_id com20020_ids[] = {313	PCMCIA_DEVICE_PROD_ID12("Contemporary Control Systems, Inc.",314				"PCM20 Arcnet Adapter", 0x59991666, 0x95dfffaf),315	PCMCIA_DEVICE_PROD_ID12("SoHard AG",316				"SH ARC PCMCIA", 0xf8991729, 0x69dff0c7),317	PCMCIA_DEVICE_NULL318};319MODULE_DEVICE_TABLE(pcmcia, com20020_ids);320 321static struct pcmcia_driver com20020_cs_driver = {322	.owner		= THIS_MODULE,323	.name		= "com20020_cs",324	.probe		= com20020_probe,325	.remove		= com20020_detach,326	.id_table	= com20020_ids,327	.suspend	= com20020_suspend,328	.resume		= com20020_resume,329};330module_pcmcia_driver(com20020_cs_driver);331