ARM: 6621/1: bitops: remove condition code clobber for CLZ
[linux-2.6.git] / drivers / net / pcmcia / com20020_cs.c
blob27bfad76fc4077bdaa74187a79c2f0beb53c4ffc
1 /*
2 * Linux ARCnet driver - COM20020 PCMCIA support
3 *
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.
10 * Special thanks to Contemporary Controls, Inc. (www.ccontrols.com)
11 * for sponsoring the further development of this driver.
13 * **********************
15 * The original copyright of skeleton.c was as follows:
17 * skeleton.c Written 1993 by Donald Becker.
18 * Copyright 1993 United States Government as represented by the
19 * Director, National Security Agency. This software may only be used
20 * and distributed according to the terms of the GNU General Public License as
21 * modified by SRC, incorporated herein by reference.
23 * **********************
24 * Changes:
25 * Arnaldo Carvalho de Melo <acme@conectiva.com.br> - 08/08/2000
26 * - reorganize kmallocs in com20020_attach, checking all for failure
27 * and releasing the previous allocations if one fails
28 * **********************
30 * For more details, see drivers/net/arcnet.c
32 * **********************
34 #include <linux/kernel.h>
35 #include <linux/init.h>
36 #include <linux/ptrace.h>
37 #include <linux/slab.h>
38 #include <linux/string.h>
39 #include <linux/timer.h>
40 #include <linux/delay.h>
41 #include <linux/module.h>
42 #include <linux/netdevice.h>
43 #include <linux/arcdevice.h>
44 #include <linux/com20020.h>
46 #include <pcmcia/cistpl.h>
47 #include <pcmcia/ds.h>
49 #include <asm/io.h>
50 #include <asm/system.h>
52 #define VERSION "arcnet: COM20020 PCMCIA support loaded.\n"
55 static void regdump(struct net_device *dev)
57 #ifdef DEBUG
58 int ioaddr = dev->base_addr;
59 int count;
61 netdev_dbg(dev, "register dump:\n");
62 for (count = ioaddr; count < ioaddr + 16; count++)
64 if (!(count % 16))
65 pr_cont("%04X:", count);
66 pr_cont(" %02X", inb(count));
68 pr_cont("\n");
70 netdev_dbg(dev, "buffer0 dump:\n");
71 /* set up the address register */
72 count = 0;
73 outb((count >> 8) | RDDATAflag | AUTOINCflag, _ADDR_HI);
74 outb(count & 0xff, _ADDR_LO);
76 for (count = 0; count < 256+32; count++)
78 if (!(count % 16))
79 pr_cont("%04X:", count);
81 /* copy the data */
82 pr_cont(" %02X", inb(_MEMDATA));
84 pr_cont("\n");
85 #endif
90 /*====================================================================*/
92 /* Parameters that can be set with 'insmod' */
94 static int node;
95 static int timeout = 3;
96 static int backplane;
97 static int clockp;
98 static int clockm;
100 module_param(node, int, 0);
101 module_param(timeout, int, 0);
102 module_param(backplane, int, 0);
103 module_param(clockp, int, 0);
104 module_param(clockm, int, 0);
106 MODULE_LICENSE("GPL");
108 /*====================================================================*/
110 static int com20020_config(struct pcmcia_device *link);
111 static void com20020_release(struct pcmcia_device *link);
113 static void com20020_detach(struct pcmcia_device *p_dev);
115 /*====================================================================*/
117 typedef struct com20020_dev_t {
118 struct net_device *dev;
119 } com20020_dev_t;
121 static int com20020_probe(struct pcmcia_device *p_dev)
123 com20020_dev_t *info;
124 struct net_device *dev;
125 struct arcnet_local *lp;
127 dev_dbg(&p_dev->dev, "com20020_attach()\n");
129 /* Create new network device */
130 info = kzalloc(sizeof(struct com20020_dev_t), GFP_KERNEL);
131 if (!info)
132 goto fail_alloc_info;
134 dev = alloc_arcdev("");
135 if (!dev)
136 goto fail_alloc_dev;
138 lp = netdev_priv(dev);
139 lp->timeout = timeout;
140 lp->backplane = backplane;
141 lp->clockp = clockp;
142 lp->clockm = clockm & 3;
143 lp->hw.owner = THIS_MODULE;
145 /* fill in our module parameters as defaults */
146 dev->dev_addr[0] = node;
148 p_dev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8;
149 p_dev->resource[0]->end = 16;
150 p_dev->config_flags |= CONF_ENABLE_IRQ;
152 info->dev = dev;
153 p_dev->priv = info;
155 return com20020_config(p_dev);
157 fail_alloc_dev:
158 kfree(info);
159 fail_alloc_info:
160 return -ENOMEM;
161 } /* com20020_attach */
163 static void com20020_detach(struct pcmcia_device *link)
165 struct com20020_dev_t *info = link->priv;
166 struct net_device *dev = info->dev;
168 dev_dbg(&link->dev, "detach...\n");
170 dev_dbg(&link->dev, "com20020_detach\n");
172 dev_dbg(&link->dev, "unregister...\n");
174 unregister_netdev(dev);
177 * this is necessary because we register our IRQ separately
178 * from card services.
180 if (dev->irq)
181 free_irq(dev->irq, dev);
183 com20020_release(link);
185 /* Unlink device structure, free bits */
186 dev_dbg(&link->dev, "unlinking...\n");
187 if (link->priv)
189 dev = info->dev;
190 if (dev)
192 dev_dbg(&link->dev, "kfree...\n");
193 free_netdev(dev);
195 dev_dbg(&link->dev, "kfree2...\n");
196 kfree(info);
199 } /* com20020_detach */
201 static int com20020_config(struct pcmcia_device *link)
203 struct arcnet_local *lp;
204 com20020_dev_t *info;
205 struct net_device *dev;
206 int i, ret;
207 int ioaddr;
209 info = link->priv;
210 dev = info->dev;
212 dev_dbg(&link->dev, "config...\n");
214 dev_dbg(&link->dev, "com20020_config\n");
216 dev_dbg(&link->dev, "baseport1 is %Xh\n",
217 (unsigned int) link->resource[0]->start);
219 i = -ENODEV;
220 link->io_lines = 16;
222 if (!link->resource[0]->start)
224 for (ioaddr = 0x100; ioaddr < 0x400; ioaddr += 0x10)
226 link->resource[0]->start = ioaddr;
227 i = pcmcia_request_io(link);
228 if (i == 0)
229 break;
232 else
233 i = pcmcia_request_io(link);
235 if (i != 0)
237 dev_dbg(&link->dev, "requestIO failed totally!\n");
238 goto failed;
241 ioaddr = dev->base_addr = link->resource[0]->start;
242 dev_dbg(&link->dev, "got ioaddr %Xh\n", ioaddr);
244 dev_dbg(&link->dev, "request IRQ %d\n",
245 link->irq);
246 if (!link->irq)
248 dev_dbg(&link->dev, "requestIRQ failed totally!\n");
249 goto failed;
252 dev->irq = link->irq;
254 ret = pcmcia_enable_device(link);
255 if (ret)
256 goto failed;
258 if (com20020_check(dev))
260 regdump(dev);
261 goto failed;
264 lp = netdev_priv(dev);
265 lp->card_name = "PCMCIA COM20020";
266 lp->card_flags = ARC_CAN_10MBIT; /* pretend all of them can 10Mbit */
268 SET_NETDEV_DEV(dev, &link->dev);
270 i = com20020_found(dev, 0); /* calls register_netdev */
272 if (i != 0) {
273 dev_notice(&link->dev,
274 "com20020_found() failed\n");
275 goto failed;
278 netdev_dbg(dev, "port %#3lx, irq %d\n",
279 dev->base_addr, dev->irq);
280 return 0;
282 failed:
283 dev_dbg(&link->dev, "com20020_config failed...\n");
284 com20020_release(link);
285 return -ENODEV;
286 } /* com20020_config */
288 static void com20020_release(struct pcmcia_device *link)
290 dev_dbg(&link->dev, "com20020_release\n");
291 pcmcia_disable_device(link);
294 static int com20020_suspend(struct pcmcia_device *link)
296 com20020_dev_t *info = link->priv;
297 struct net_device *dev = info->dev;
299 if (link->open)
300 netif_device_detach(dev);
302 return 0;
305 static int com20020_resume(struct pcmcia_device *link)
307 com20020_dev_t *info = link->priv;
308 struct net_device *dev = info->dev;
310 if (link->open) {
311 int ioaddr = dev->base_addr;
312 struct arcnet_local *lp = netdev_priv(dev);
313 ARCRESET;
316 return 0;
319 static struct pcmcia_device_id com20020_ids[] = {
320 PCMCIA_DEVICE_PROD_ID12("Contemporary Control Systems, Inc.",
321 "PCM20 Arcnet Adapter", 0x59991666, 0x95dfffaf),
322 PCMCIA_DEVICE_PROD_ID12("SoHard AG",
323 "SH ARC PCMCIA", 0xf8991729, 0x69dff0c7),
324 PCMCIA_DEVICE_NULL
326 MODULE_DEVICE_TABLE(pcmcia, com20020_ids);
328 static struct pcmcia_driver com20020_cs_driver = {
329 .owner = THIS_MODULE,
330 .name = "com20020_cs",
331 .probe = com20020_probe,
332 .remove = com20020_detach,
333 .id_table = com20020_ids,
334 .suspend = com20020_suspend,
335 .resume = com20020_resume,
338 static int __init init_com20020_cs(void)
340 return pcmcia_register_driver(&com20020_cs_driver);
343 static void __exit exit_com20020_cs(void)
345 pcmcia_unregister_driver(&com20020_cs_driver);
348 module_init(init_com20020_cs);
349 module_exit(exit_com20020_cs);