OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / net / arcnet / arc-rimi.c
blob25197b698dd64efad9243bc6579f4808d6a93802
1 /*
2 * Linux ARCnet driver - "RIM I" (entirely mem-mapped) cards
3 *
4 * Written 1994-1999 by Avery Pennarun.
5 * Written 1999-2000 by Martin Mares <mj@ucw.cz>.
6 * Derived from skeleton.c by Donald Becker.
8 * Special thanks to Contemporary Controls, Inc. (www.ccontrols.com)
9 * for sponsoring the further development of this driver.
11 * **********************
13 * The original copyright of skeleton.c was as follows:
15 * skeleton.c Written 1993 by Donald Becker.
16 * Copyright 1993 United States Government as represented by the
17 * Director, National Security Agency. This software may only be used
18 * and distributed according to the terms of the GNU General Public License as
19 * modified by SRC, incorporated herein by reference.
21 * **********************
23 * For more details, see drivers/net/arcnet.c
25 * **********************
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/moduleparam.h>
30 #include <linux/ioport.h>
31 #include <linux/delay.h>
32 #include <linux/netdevice.h>
33 #include <linux/bootmem.h>
34 #include <linux/init.h>
35 #include <linux/interrupt.h>
36 #include <asm/io.h>
37 #include <linux/arcdevice.h>
40 #define VERSION "arcnet: RIM I (entirely mem-mapped) support\n"
43 /* Internal function declarations */
45 static int arcrimi_probe(struct net_device *dev);
46 static int arcrimi_found(struct net_device *dev);
47 static void arcrimi_command(struct net_device *dev, int command);
48 static int arcrimi_status(struct net_device *dev);
49 static void arcrimi_setmask(struct net_device *dev, int mask);
50 static int arcrimi_reset(struct net_device *dev, int really_reset);
51 static void arcrimi_copy_to_card(struct net_device *dev, int bufnum, int offset,
52 void *buf, int count);
53 static void arcrimi_copy_from_card(struct net_device *dev, int bufnum, int offset,
54 void *buf, int count);
56 /* Handy defines for ARCnet specific stuff */
58 /* Amount of I/O memory used by the card */
59 #define BUFFER_SIZE (512)
60 #define MIRROR_SIZE (BUFFER_SIZE*4)
62 /* COM 9026 controller chip --> ARCnet register addresses */
63 #define _INTMASK (ioaddr+0) /* writable */
64 #define _STATUS (ioaddr+0) /* readable */
65 #define _COMMAND (ioaddr+1) /* writable, returns random vals on read (?) */
66 #define _RESET (ioaddr+8) /* software reset (on read) */
67 #define _MEMDATA (ioaddr+12) /* Data port for IO-mapped memory */
68 #define _ADDR_HI (ioaddr+15) /* Control registers for said */
69 #define _ADDR_LO (ioaddr+14)
70 #define _CONFIG (ioaddr+2) /* Configuration register */
72 #undef ASTATUS
73 #undef ACOMMAND
74 #undef AINTMASK
76 #define ASTATUS() readb(_STATUS)
77 #define ACOMMAND(cmd) writeb((cmd),_COMMAND)
78 #define AINTMASK(msk) writeb((msk),_INTMASK)
79 #define SETCONF() writeb(lp->config,_CONFIG)
83 * We cannot probe for a RIM I card; one reason is I don't know how to reset
84 * them. In fact, we can't even get their node ID automatically. So, we
85 * need to be passed a specific shmem address, IRQ, and node ID.
87 static int __init arcrimi_probe(struct net_device *dev)
89 BUGLVL(D_NORMAL) printk(VERSION);
90 BUGLVL(D_NORMAL) printk("E-mail me if you actually test the RIM I driver, please!\n");
92 BUGMSG(D_NORMAL, "Given: node %02Xh, shmem %lXh, irq %d\n",
93 dev->dev_addr[0], dev->mem_start, dev->irq);
95 if (dev->mem_start <= 0 || dev->irq <= 0) {
96 BUGMSG(D_NORMAL, "No autoprobe for RIM I; you "
97 "must specify the shmem and irq!\n");
98 return -ENODEV;
100 if (dev->dev_addr[0] == 0) {
101 BUGMSG(D_NORMAL, "You need to specify your card's station "
102 "ID!\n");
103 return -ENODEV;
106 * Grab the memory region at mem_start for MIRROR_SIZE bytes.
107 * Later in arcrimi_found() the real size will be determined
108 * and this reserve will be released and the correct size
109 * will be taken.
111 if (!request_mem_region(dev->mem_start, MIRROR_SIZE, "arcnet (90xx)")) {
112 BUGMSG(D_NORMAL, "Card memory already allocated\n");
113 return -ENODEV;
115 return arcrimi_found(dev);
118 static int check_mirror(unsigned long addr, size_t size)
120 void __iomem *p;
121 int res = -1;
123 if (!request_mem_region(addr, size, "arcnet (90xx)"))
124 return -1;
126 p = ioremap(addr, size);
127 if (p) {
128 if (readb(p) == TESTvalue)
129 res = 1;
130 else
131 res = 0;
132 iounmap(p);
135 release_mem_region(addr, size);
136 return res;
140 * Set up the struct net_device associated with this card. Called after
141 * probing succeeds.
143 static int __init arcrimi_found(struct net_device *dev)
145 struct arcnet_local *lp;
146 unsigned long first_mirror, last_mirror, shmem;
147 void __iomem *p;
148 int mirror_size;
149 int err;
151 p = ioremap(dev->mem_start, MIRROR_SIZE);
152 if (!p) {
153 release_mem_region(dev->mem_start, MIRROR_SIZE);
154 BUGMSG(D_NORMAL, "Can't ioremap\n");
155 return -ENODEV;
158 /* reserve the irq */
159 if (request_irq(dev->irq, arcnet_interrupt, 0, "arcnet (RIM I)", dev)) {
160 iounmap(p);
161 release_mem_region(dev->mem_start, MIRROR_SIZE);
162 BUGMSG(D_NORMAL, "Can't get IRQ %d!\n", dev->irq);
163 return -ENODEV;
166 shmem = dev->mem_start;
167 writeb(TESTvalue, p);
168 writeb(dev->dev_addr[0], p + 1); /* actually the node ID */
170 /* find the real shared memory start/end points, including mirrors */
172 /* guess the actual size of one "memory mirror" - the number of
173 * bytes between copies of the shared memory. On most cards, it's
174 * 2k (or there are no mirrors at all) but on some, it's 4k.
176 mirror_size = MIRROR_SIZE;
177 if (readb(p) == TESTvalue &&
178 check_mirror(shmem - MIRROR_SIZE, MIRROR_SIZE) == 0 &&
179 check_mirror(shmem - 2 * MIRROR_SIZE, MIRROR_SIZE) == 1)
180 mirror_size = 2 * MIRROR_SIZE;
182 first_mirror = shmem - mirror_size;
183 while (check_mirror(first_mirror, mirror_size) == 1)
184 first_mirror -= mirror_size;
185 first_mirror += mirror_size;
187 last_mirror = shmem + mirror_size;
188 while (check_mirror(last_mirror, mirror_size) == 1)
189 last_mirror += mirror_size;
190 last_mirror -= mirror_size;
192 dev->mem_start = first_mirror;
193 dev->mem_end = last_mirror + MIRROR_SIZE - 1;
195 /* initialize the rest of the device structure. */
197 lp = netdev_priv(dev);
198 lp->card_name = "RIM I";
199 lp->hw.command = arcrimi_command;
200 lp->hw.status = arcrimi_status;
201 lp->hw.intmask = arcrimi_setmask;
202 lp->hw.reset = arcrimi_reset;
203 lp->hw.owner = THIS_MODULE;
204 lp->hw.copy_to_card = arcrimi_copy_to_card;
205 lp->hw.copy_from_card = arcrimi_copy_from_card;
208 * re-reserve the memory region - arcrimi_probe() alloced this reqion
209 * but didn't know the real size. Free that region and then re-get
210 * with the correct size. There is a VERY slim chance this could
211 * fail.
213 iounmap(p);
214 release_mem_region(shmem, MIRROR_SIZE);
215 if (!request_mem_region(dev->mem_start,
216 dev->mem_end - dev->mem_start + 1,
217 "arcnet (90xx)")) {
218 BUGMSG(D_NORMAL, "Card memory already allocated\n");
219 goto err_free_irq;
222 lp->mem_start = ioremap(dev->mem_start, dev->mem_end - dev->mem_start + 1);
223 if (!lp->mem_start) {
224 BUGMSG(D_NORMAL, "Can't remap device memory!\n");
225 goto err_release_mem;
228 /* get and check the station ID from offset 1 in shmem */
229 dev->dev_addr[0] = readb(lp->mem_start + 1);
231 BUGMSG(D_NORMAL, "ARCnet RIM I: station %02Xh found at IRQ %d, "
232 "ShMem %lXh (%ld*%d bytes).\n",
233 dev->dev_addr[0],
234 dev->irq, dev->mem_start,
235 (dev->mem_end - dev->mem_start + 1) / mirror_size, mirror_size);
237 err = register_netdev(dev);
238 if (err)
239 goto err_unmap;
241 return 0;
243 err_unmap:
244 iounmap(lp->mem_start);
245 err_release_mem:
246 release_mem_region(dev->mem_start, dev->mem_end - dev->mem_start + 1);
247 err_free_irq:
248 free_irq(dev->irq, dev);
249 return -EIO;
254 * Do a hardware reset on the card, and set up necessary registers.
256 * This should be called as little as possible, because it disrupts the
257 * token on the network (causes a RECON) and requires a significant delay.
259 * However, it does make sure the card is in a defined state.
261 static int arcrimi_reset(struct net_device *dev, int really_reset)
263 struct arcnet_local *lp = netdev_priv(dev);
264 void __iomem *ioaddr = lp->mem_start + 0x800;
266 BUGMSG(D_INIT, "Resetting %s (status=%02Xh)\n", dev->name, ASTATUS());
268 if (really_reset) {
269 writeb(TESTvalue, ioaddr - 0x800); /* fake reset */
270 return 0;
272 ACOMMAND(CFLAGScmd | RESETclear); /* clear flags & end reset */
273 ACOMMAND(CFLAGScmd | CONFIGclear);
275 /* enable extended (512-byte) packets */
276 ACOMMAND(CONFIGcmd | EXTconf);
278 /* done! return success. */
279 return 0;
282 static void arcrimi_setmask(struct net_device *dev, int mask)
284 struct arcnet_local *lp = netdev_priv(dev);
285 void __iomem *ioaddr = lp->mem_start + 0x800;
287 AINTMASK(mask);
290 static int arcrimi_status(struct net_device *dev)
292 struct arcnet_local *lp = netdev_priv(dev);
293 void __iomem *ioaddr = lp->mem_start + 0x800;
295 return ASTATUS();
298 static void arcrimi_command(struct net_device *dev, int cmd)
300 struct arcnet_local *lp = netdev_priv(dev);
301 void __iomem *ioaddr = lp->mem_start + 0x800;
303 ACOMMAND(cmd);
306 static void arcrimi_copy_to_card(struct net_device *dev, int bufnum, int offset,
307 void *buf, int count)
309 struct arcnet_local *lp = netdev_priv(dev);
310 void __iomem *memaddr = lp->mem_start + 0x800 + bufnum * 512 + offset;
311 TIME("memcpy_toio", count, memcpy_toio(memaddr, buf, count));
315 static void arcrimi_copy_from_card(struct net_device *dev, int bufnum, int offset,
316 void *buf, int count)
318 struct arcnet_local *lp = netdev_priv(dev);
319 void __iomem *memaddr = lp->mem_start + 0x800 + bufnum * 512 + offset;
320 TIME("memcpy_fromio", count, memcpy_fromio(buf, memaddr, count));
323 static int node;
324 static int io; /* use the insmod io= irq= node= options */
325 static int irq;
326 static char device[9]; /* use eg. device=arc1 to change name */
328 module_param(node, int, 0);
329 module_param(io, int, 0);
330 module_param(irq, int, 0);
331 module_param_string(device, device, sizeof(device), 0);
332 MODULE_LICENSE("GPL");
334 static struct net_device *my_dev;
336 static int __init arc_rimi_init(void)
338 struct net_device *dev;
340 dev = alloc_arcdev(device);
341 if (!dev)
342 return -ENOMEM;
344 if (node && node != 0xff)
345 dev->dev_addr[0] = node;
347 dev->mem_start = io;
348 dev->irq = irq;
349 if (dev->irq == 2)
350 dev->irq = 9;
352 if (arcrimi_probe(dev)) {
353 free_netdev(dev);
354 return -EIO;
357 my_dev = dev;
358 return 0;
361 static void __exit arc_rimi_exit(void)
363 struct net_device *dev = my_dev;
364 struct arcnet_local *lp = netdev_priv(dev);
366 unregister_netdev(dev);
367 iounmap(lp->mem_start);
368 release_mem_region(dev->mem_start, dev->mem_end - dev->mem_start + 1);
369 free_irq(dev->irq, dev);
370 free_netdev(dev);
373 #ifndef MODULE
374 static int __init arcrimi_setup(char *s)
376 int ints[8];
377 s = get_options(s, 8, ints);
378 if (!ints[0])
379 return 1;
380 switch (ints[0]) {
381 default: /* ERROR */
382 printk("arcrimi: Too many arguments.\n");
383 case 3: /* Node ID */
384 node = ints[3];
385 case 2: /* IRQ */
386 irq = ints[2];
387 case 1: /* IO address */
388 io = ints[1];
390 if (*s)
391 snprintf(device, sizeof(device), "%s", s);
392 return 1;
394 __setup("arcrimi=", arcrimi_setup);
395 #endif /* MODULE */
397 module_init(arc_rimi_init)
398 module_exit(arc_rimi_exit)