Complete the renaming to TuxOnIce with function names, vars etc.
[linux-2.6/suspend2-head.git] / drivers / net / macsonic.c
blobe9ecdbf352ae36b8096eeb9c3abd1cbd1049dfe2
1 /*
2 * macsonic.c
4 * (C) 2005 Finn Thain
6 * Converted to DMA API, converted to unified driver model, made it work as
7 * a module again, and from the mac68k project, introduced more 32-bit cards
8 * and dhd's support for 16-bit cards.
10 * (C) 1998 Alan Cox
12 * Debugging Andreas Ehliar, Michael Schmitz
14 * Based on code
15 * (C) 1996 by Thomas Bogendoerfer (tsbogend@bigbug.franken.de)
17 * This driver is based on work from Andreas Busse, but most of
18 * the code is rewritten.
20 * (C) 1995 by Andreas Busse (andy@waldorf-gmbh.de)
22 * A driver for the Mac onboard Sonic ethernet chip.
24 * 98/12/21 MSch: judged from tests on Q800, it's basically working,
25 * but eating up both receive and transmit resources
26 * and duplicating packets. Needs more testing.
28 * 99/01/03 MSch: upgraded to version 0.92 of the core driver, fixed.
30 * 00/10/31 sammy@oh.verio.com: Updated driver for 2.4 kernels, fixed problems
31 * on centris.
34 #include <linux/kernel.h>
35 #include <linux/module.h>
36 #include <linux/types.h>
37 #include <linux/fcntl.h>
38 #include <linux/interrupt.h>
39 #include <linux/init.h>
40 #include <linux/ioport.h>
41 #include <linux/in.h>
42 #include <linux/slab.h>
43 #include <linux/string.h>
44 #include <linux/delay.h>
45 #include <linux/nubus.h>
46 #include <linux/errno.h>
47 #include <linux/netdevice.h>
48 #include <linux/etherdevice.h>
49 #include <linux/skbuff.h>
50 #include <linux/platform_device.h>
51 #include <linux/dma-mapping.h>
52 #include <linux/bitrev.h>
54 #include <asm/bootinfo.h>
55 #include <asm/system.h>
56 #include <asm/pgtable.h>
57 #include <asm/io.h>
58 #include <asm/hwtest.h>
59 #include <asm/dma.h>
60 #include <asm/macintosh.h>
61 #include <asm/macints.h>
62 #include <asm/mac_via.h>
64 static char mac_sonic_string[] = "macsonic";
65 static struct platform_device *mac_sonic_device;
67 #include "sonic.h"
69 /* These should basically be bus-size and endian independent (since
70 the SONIC is at least smart enough that it uses the same endianness
71 as the host, unlike certain less enlightened Macintosh NICs) */
72 #define SONIC_READ(reg) (nubus_readw(dev->base_addr + (reg * 4) \
73 + lp->reg_offset))
74 #define SONIC_WRITE(reg,val) (nubus_writew(val, dev->base_addr + (reg * 4) \
75 + lp->reg_offset))
77 /* use 0 for production, 1 for verification, >1 for debug */
78 #ifdef SONIC_DEBUG
79 static unsigned int sonic_debug = SONIC_DEBUG;
80 #else
81 static unsigned int sonic_debug = 1;
82 #endif
84 static int sonic_version_printed;
86 extern int mac_onboard_sonic_probe(struct net_device* dev);
87 extern int mac_nubus_sonic_probe(struct net_device* dev);
89 /* For onboard SONIC */
90 #define ONBOARD_SONIC_REGISTERS 0x50F0A000
91 #define ONBOARD_SONIC_PROM_BASE 0x50f08000
93 enum macsonic_type {
94 MACSONIC_DUODOCK,
95 MACSONIC_APPLE,
96 MACSONIC_APPLE16,
97 MACSONIC_DAYNA,
98 MACSONIC_DAYNALINK
101 /* For the built-in SONIC in the Duo Dock */
102 #define DUODOCK_SONIC_REGISTERS 0xe10000
103 #define DUODOCK_SONIC_PROM_BASE 0xe12000
105 /* For Apple-style NuBus SONIC */
106 #define APPLE_SONIC_REGISTERS 0
107 #define APPLE_SONIC_PROM_BASE 0x40000
109 /* Daynalink LC SONIC */
110 #define DAYNALINK_PROM_BASE 0x400000
112 /* For Dayna-style NuBus SONIC (haven't seen one yet) */
113 #define DAYNA_SONIC_REGISTERS 0x180000
114 /* This is what OpenBSD says. However, this is definitely in NuBus
115 ROM space so we should be able to get it by walking the NuBus
116 resource directories */
117 #define DAYNA_SONIC_MAC_ADDR 0xffe004
119 #define SONIC_READ_PROM(addr) nubus_readb(prom_addr+addr)
122 * For reversing the PROM address
125 static inline void bit_reverse_addr(unsigned char addr[6])
127 int i;
129 for(i = 0; i < 6; i++)
130 addr[i] = bitrev8(addr[i]);
133 static irqreturn_t macsonic_interrupt(int irq, void *dev_id)
135 irqreturn_t result;
136 unsigned long flags;
138 local_irq_save(flags);
139 result = sonic_interrupt(irq, dev_id);
140 local_irq_restore(flags);
141 return result;
144 static int macsonic_open(struct net_device* dev)
146 if (request_irq(dev->irq, &sonic_interrupt, IRQ_FLG_FAST, "sonic", dev)) {
147 printk(KERN_ERR "%s: unable to get IRQ %d.\n", dev->name, dev->irq);
148 return -EAGAIN;
150 /* Under the A/UX interrupt scheme, the onboard SONIC interrupt comes
151 * in at priority level 3. However, we sometimes get the level 2 inter-
152 * rupt as well, which must prevent re-entrance of the sonic handler.
154 if (dev->irq == IRQ_AUTO_3)
155 if (request_irq(IRQ_NUBUS_9, &macsonic_interrupt, IRQ_FLG_FAST, "sonic", dev)) {
156 printk(KERN_ERR "%s: unable to get IRQ %d.\n", dev->name, IRQ_NUBUS_9);
157 free_irq(dev->irq, dev);
158 return -EAGAIN;
160 return sonic_open(dev);
163 static int macsonic_close(struct net_device* dev)
165 int err;
166 err = sonic_close(dev);
167 free_irq(dev->irq, dev);
168 if (dev->irq == IRQ_AUTO_3)
169 free_irq(IRQ_NUBUS_9, dev);
170 return err;
173 int __init macsonic_init(struct net_device* dev)
175 struct sonic_local* lp = netdev_priv(dev);
177 /* Allocate the entire chunk of memory for the descriptors.
178 Note that this cannot cross a 64K boundary. */
179 if ((lp->descriptors = dma_alloc_coherent(lp->device,
180 SIZEOF_SONIC_DESC * SONIC_BUS_SCALE(lp->dma_bitmode),
181 &lp->descriptors_laddr, GFP_KERNEL)) == NULL) {
182 printk(KERN_ERR "%s: couldn't alloc DMA memory for descriptors.\n", lp->device->bus_id);
183 return -ENOMEM;
186 /* Now set up the pointers to point to the appropriate places */
187 lp->cda = lp->descriptors;
188 lp->tda = lp->cda + (SIZEOF_SONIC_CDA
189 * SONIC_BUS_SCALE(lp->dma_bitmode));
190 lp->rda = lp->tda + (SIZEOF_SONIC_TD * SONIC_NUM_TDS
191 * SONIC_BUS_SCALE(lp->dma_bitmode));
192 lp->rra = lp->rda + (SIZEOF_SONIC_RD * SONIC_NUM_RDS
193 * SONIC_BUS_SCALE(lp->dma_bitmode));
195 lp->cda_laddr = lp->descriptors_laddr;
196 lp->tda_laddr = lp->cda_laddr + (SIZEOF_SONIC_CDA
197 * SONIC_BUS_SCALE(lp->dma_bitmode));
198 lp->rda_laddr = lp->tda_laddr + (SIZEOF_SONIC_TD * SONIC_NUM_TDS
199 * SONIC_BUS_SCALE(lp->dma_bitmode));
200 lp->rra_laddr = lp->rda_laddr + (SIZEOF_SONIC_RD * SONIC_NUM_RDS
201 * SONIC_BUS_SCALE(lp->dma_bitmode));
203 dev->open = macsonic_open;
204 dev->stop = macsonic_close;
205 dev->hard_start_xmit = sonic_send_packet;
206 dev->get_stats = sonic_get_stats;
207 dev->set_multicast_list = &sonic_multicast_list;
208 dev->tx_timeout = sonic_tx_timeout;
209 dev->watchdog_timeo = TX_TIMEOUT;
212 * clear tally counter
214 SONIC_WRITE(SONIC_CRCT, 0xffff);
215 SONIC_WRITE(SONIC_FAET, 0xffff);
216 SONIC_WRITE(SONIC_MPT, 0xffff);
218 return 0;
221 int __init mac_onboard_sonic_ethernet_addr(struct net_device* dev)
223 struct sonic_local *lp = netdev_priv(dev);
224 const int prom_addr = ONBOARD_SONIC_PROM_BASE;
225 int i;
227 /* On NuBus boards we can sometimes look in the ROM resources.
228 No such luck for comm-slot/onboard. */
229 for(i = 0; i < 6; i++)
230 dev->dev_addr[i] = SONIC_READ_PROM(i);
232 /* Most of the time, the address is bit-reversed. The NetBSD
233 source has a rather long and detailed historical account of
234 why this is so. */
235 if (memcmp(dev->dev_addr, "\x08\x00\x07", 3) &&
236 memcmp(dev->dev_addr, "\x00\xA0\x40", 3) &&
237 memcmp(dev->dev_addr, "\x00\x80\x19", 3) &&
238 memcmp(dev->dev_addr, "\x00\x05\x02", 3))
239 bit_reverse_addr(dev->dev_addr);
240 else
241 return 0;
243 /* If we still have what seems to be a bogus address, we'll
244 look in the CAM. The top entry should be ours. */
245 /* Danger! This only works if MacOS has already initialized
246 the card... */
247 if (memcmp(dev->dev_addr, "\x08\x00\x07", 3) &&
248 memcmp(dev->dev_addr, "\x00\xA0\x40", 3) &&
249 memcmp(dev->dev_addr, "\x00\x80\x19", 3) &&
250 memcmp(dev->dev_addr, "\x00\x05\x02", 3))
252 unsigned short val;
254 printk(KERN_INFO "macsonic: PROM seems to be wrong, trying CAM entry 15\n");
256 SONIC_WRITE(SONIC_CMD, SONIC_CR_RST);
257 SONIC_WRITE(SONIC_CEP, 15);
259 val = SONIC_READ(SONIC_CAP2);
260 dev->dev_addr[5] = val >> 8;
261 dev->dev_addr[4] = val & 0xff;
262 val = SONIC_READ(SONIC_CAP1);
263 dev->dev_addr[3] = val >> 8;
264 dev->dev_addr[2] = val & 0xff;
265 val = SONIC_READ(SONIC_CAP0);
266 dev->dev_addr[1] = val >> 8;
267 dev->dev_addr[0] = val & 0xff;
269 printk(KERN_INFO "HW Address from CAM 15: ");
270 for (i = 0; i < 6; i++) {
271 printk("%2.2x", dev->dev_addr[i]);
272 if (i < 5)
273 printk(":");
275 printk("\n");
276 } else return 0;
278 if (memcmp(dev->dev_addr, "\x08\x00\x07", 3) &&
279 memcmp(dev->dev_addr, "\x00\xA0\x40", 3) &&
280 memcmp(dev->dev_addr, "\x00\x80\x19", 3) &&
281 memcmp(dev->dev_addr, "\x00\x05\x02", 3))
284 * Still nonsense ... messed up someplace!
286 printk(KERN_ERR "macsonic: ERROR (INVALID MAC)\n");
287 return -EIO;
288 } else return 0;
291 int __init mac_onboard_sonic_probe(struct net_device* dev)
293 /* Bwahahaha */
294 static int once_is_more_than_enough;
295 struct sonic_local* lp = netdev_priv(dev);
296 int sr;
297 int commslot = 0;
299 if (once_is_more_than_enough)
300 return -ENODEV;
301 once_is_more_than_enough = 1;
303 if (!MACH_IS_MAC)
304 return -ENODEV;
306 if (macintosh_config->ether_type != MAC_ETHER_SONIC)
307 return -ENODEV;
309 printk(KERN_INFO "Checking for internal Macintosh ethernet (SONIC).. ");
311 /* Bogus probing, on the models which may or may not have
312 Ethernet (BTW, the Ethernet *is* always at the same
313 address, and nothing else lives there, at least if Apple's
314 documentation is to be believed) */
315 if (macintosh_config->ident == MAC_MODEL_Q630 ||
316 macintosh_config->ident == MAC_MODEL_P588 ||
317 macintosh_config->ident == MAC_MODEL_P575 ||
318 macintosh_config->ident == MAC_MODEL_C610) {
319 unsigned long flags;
320 int card_present;
322 local_irq_save(flags);
323 card_present = hwreg_present((void*)ONBOARD_SONIC_REGISTERS);
324 local_irq_restore(flags);
326 if (!card_present) {
327 printk("none.\n");
328 return -ENODEV;
330 commslot = 1;
333 printk("yes\n");
335 /* Danger! My arms are flailing wildly! You *must* set lp->reg_offset
336 * and dev->base_addr before using SONIC_READ() or SONIC_WRITE() */
337 dev->base_addr = ONBOARD_SONIC_REGISTERS;
338 if (via_alt_mapping)
339 dev->irq = IRQ_AUTO_3;
340 else
341 dev->irq = IRQ_NUBUS_9;
343 if (!sonic_version_printed) {
344 printk(KERN_INFO "%s", version);
345 sonic_version_printed = 1;
347 printk(KERN_INFO "%s: onboard / comm-slot SONIC at 0x%08lx\n",
348 lp->device->bus_id, dev->base_addr);
350 /* The PowerBook's SONIC is 16 bit always. */
351 if (macintosh_config->ident == MAC_MODEL_PB520) {
352 lp->reg_offset = 0;
353 lp->dma_bitmode = SONIC_BITMODE16;
354 sr = SONIC_READ(SONIC_SR);
355 } else if (commslot) {
356 /* Some of the comm-slot cards are 16 bit. But some
357 of them are not. The 32-bit cards use offset 2 and
358 have known revisions, we try reading the revision
359 register at offset 2, if we don't get a known revision
360 we assume 16 bit at offset 0. */
361 lp->reg_offset = 2;
362 lp->dma_bitmode = SONIC_BITMODE16;
364 sr = SONIC_READ(SONIC_SR);
365 if (sr == 0x0004 || sr == 0x0006 || sr == 0x0100 || sr == 0x0101)
366 /* 83932 is 0x0004 or 0x0006, 83934 is 0x0100 or 0x0101 */
367 lp->dma_bitmode = SONIC_BITMODE32;
368 else {
369 lp->dma_bitmode = SONIC_BITMODE16;
370 lp->reg_offset = 0;
371 sr = SONIC_READ(SONIC_SR);
373 } else {
374 /* All onboard cards are at offset 2 with 32 bit DMA. */
375 lp->reg_offset = 2;
376 lp->dma_bitmode = SONIC_BITMODE32;
377 sr = SONIC_READ(SONIC_SR);
379 printk(KERN_INFO
380 "%s: revision 0x%04x, using %d bit DMA and register offset %d\n",
381 lp->device->bus_id, sr, lp->dma_bitmode?32:16, lp->reg_offset);
383 #if 0 /* This is sometimes useful to find out how MacOS configured the card. */
384 printk(KERN_INFO "%s: DCR: 0x%04x, DCR2: 0x%04x\n", lp->device->bus_id,
385 SONIC_READ(SONIC_DCR) & 0xffff, SONIC_READ(SONIC_DCR2) & 0xffff);
386 #endif
388 /* Software reset, then initialize control registers. */
389 SONIC_WRITE(SONIC_CMD, SONIC_CR_RST);
391 SONIC_WRITE(SONIC_DCR, SONIC_DCR_EXBUS | SONIC_DCR_BMS |
392 SONIC_DCR_RFT1 | SONIC_DCR_TFT0 |
393 (lp->dma_bitmode ? SONIC_DCR_DW : 0));
395 /* This *must* be written back to in order to restore the
396 * extended programmable output bits, as it may not have been
397 * initialised since the hardware reset. */
398 SONIC_WRITE(SONIC_DCR2, 0);
400 /* Clear *and* disable interrupts to be on the safe side */
401 SONIC_WRITE(SONIC_IMR, 0);
402 SONIC_WRITE(SONIC_ISR, 0x7fff);
404 /* Now look for the MAC address. */
405 if (mac_onboard_sonic_ethernet_addr(dev) != 0)
406 return -ENODEV;
408 /* Shared init code */
409 return macsonic_init(dev);
412 int __init mac_nubus_sonic_ethernet_addr(struct net_device* dev,
413 unsigned long prom_addr,
414 int id)
416 int i;
417 for(i = 0; i < 6; i++)
418 dev->dev_addr[i] = SONIC_READ_PROM(i);
420 /* Some of the addresses are bit-reversed */
421 if (id != MACSONIC_DAYNA)
422 bit_reverse_addr(dev->dev_addr);
424 return 0;
427 int __init macsonic_ident(struct nubus_dev* ndev)
429 if (ndev->dr_hw == NUBUS_DRHW_ASANTE_LC &&
430 ndev->dr_sw == NUBUS_DRSW_SONIC_LC)
431 return MACSONIC_DAYNALINK;
432 if (ndev->dr_hw == NUBUS_DRHW_SONIC &&
433 ndev->dr_sw == NUBUS_DRSW_APPLE) {
434 /* There has to be a better way to do this... */
435 if (strstr(ndev->board->name, "DuoDock"))
436 return MACSONIC_DUODOCK;
437 else
438 return MACSONIC_APPLE;
441 if (ndev->dr_hw == NUBUS_DRHW_SMC9194 &&
442 ndev->dr_sw == NUBUS_DRSW_DAYNA)
443 return MACSONIC_DAYNA;
445 if (ndev->dr_hw == NUBUS_DRHW_APPLE_SONIC_LC &&
446 ndev->dr_sw == 0) { /* huh? */
447 return MACSONIC_APPLE16;
449 return -1;
452 int __init mac_nubus_sonic_probe(struct net_device* dev)
454 static int slots;
455 struct nubus_dev* ndev = NULL;
456 struct sonic_local* lp = netdev_priv(dev);
457 unsigned long base_addr, prom_addr;
458 u16 sonic_dcr;
459 int id = -1;
460 int reg_offset, dma_bitmode;
462 /* Find the first SONIC that hasn't been initialized already */
463 while ((ndev = nubus_find_type(NUBUS_CAT_NETWORK,
464 NUBUS_TYPE_ETHERNET, ndev)) != NULL)
466 /* Have we seen it already? */
467 if (slots & (1<<ndev->board->slot))
468 continue;
469 slots |= 1<<ndev->board->slot;
471 /* Is it one of ours? */
472 if ((id = macsonic_ident(ndev)) != -1)
473 break;
476 if (ndev == NULL)
477 return -ENODEV;
479 switch (id) {
480 case MACSONIC_DUODOCK:
481 base_addr = ndev->board->slot_addr + DUODOCK_SONIC_REGISTERS;
482 prom_addr = ndev->board->slot_addr + DUODOCK_SONIC_PROM_BASE;
483 sonic_dcr = SONIC_DCR_EXBUS | SONIC_DCR_RFT0 | SONIC_DCR_RFT1 |
484 SONIC_DCR_TFT0;
485 reg_offset = 2;
486 dma_bitmode = SONIC_BITMODE32;
487 break;
488 case MACSONIC_APPLE:
489 base_addr = ndev->board->slot_addr + APPLE_SONIC_REGISTERS;
490 prom_addr = ndev->board->slot_addr + APPLE_SONIC_PROM_BASE;
491 sonic_dcr = SONIC_DCR_BMS | SONIC_DCR_RFT1 | SONIC_DCR_TFT0;
492 reg_offset = 0;
493 dma_bitmode = SONIC_BITMODE32;
494 break;
495 case MACSONIC_APPLE16:
496 base_addr = ndev->board->slot_addr + APPLE_SONIC_REGISTERS;
497 prom_addr = ndev->board->slot_addr + APPLE_SONIC_PROM_BASE;
498 sonic_dcr = SONIC_DCR_EXBUS | SONIC_DCR_RFT1 | SONIC_DCR_TFT0 |
499 SONIC_DCR_PO1 | SONIC_DCR_BMS;
500 reg_offset = 0;
501 dma_bitmode = SONIC_BITMODE16;
502 break;
503 case MACSONIC_DAYNALINK:
504 base_addr = ndev->board->slot_addr + APPLE_SONIC_REGISTERS;
505 prom_addr = ndev->board->slot_addr + DAYNALINK_PROM_BASE;
506 sonic_dcr = SONIC_DCR_RFT1 | SONIC_DCR_TFT0 |
507 SONIC_DCR_PO1 | SONIC_DCR_BMS;
508 reg_offset = 0;
509 dma_bitmode = SONIC_BITMODE16;
510 break;
511 case MACSONIC_DAYNA:
512 base_addr = ndev->board->slot_addr + DAYNA_SONIC_REGISTERS;
513 prom_addr = ndev->board->slot_addr + DAYNA_SONIC_MAC_ADDR;
514 sonic_dcr = SONIC_DCR_BMS |
515 SONIC_DCR_RFT1 | SONIC_DCR_TFT0 | SONIC_DCR_PO1;
516 reg_offset = 0;
517 dma_bitmode = SONIC_BITMODE16;
518 break;
519 default:
520 printk(KERN_ERR "macsonic: WTF, id is %d\n", id);
521 return -ENODEV;
524 /* Danger! My arms are flailing wildly! You *must* set lp->reg_offset
525 * and dev->base_addr before using SONIC_READ() or SONIC_WRITE() */
526 dev->base_addr = base_addr;
527 lp->reg_offset = reg_offset;
528 lp->dma_bitmode = dma_bitmode;
529 dev->irq = SLOT2IRQ(ndev->board->slot);
531 if (!sonic_version_printed) {
532 printk(KERN_INFO "%s", version);
533 sonic_version_printed = 1;
535 printk(KERN_INFO "%s: %s in slot %X\n",
536 lp->device->bus_id, ndev->board->name, ndev->board->slot);
537 printk(KERN_INFO "%s: revision 0x%04x, using %d bit DMA and register offset %d\n",
538 lp->device->bus_id, SONIC_READ(SONIC_SR), dma_bitmode?32:16, reg_offset);
540 #if 0 /* This is sometimes useful to find out how MacOS configured the card. */
541 printk(KERN_INFO "%s: DCR: 0x%04x, DCR2: 0x%04x\n", lp->device->bus_id,
542 SONIC_READ(SONIC_DCR) & 0xffff, SONIC_READ(SONIC_DCR2) & 0xffff);
543 #endif
545 /* Software reset, then initialize control registers. */
546 SONIC_WRITE(SONIC_CMD, SONIC_CR_RST);
547 SONIC_WRITE(SONIC_DCR, sonic_dcr | (dma_bitmode ? SONIC_DCR_DW : 0));
548 /* This *must* be written back to in order to restore the
549 * extended programmable output bits, since it may not have been
550 * initialised since the hardware reset. */
551 SONIC_WRITE(SONIC_DCR2, 0);
553 /* Clear *and* disable interrupts to be on the safe side */
554 SONIC_WRITE(SONIC_IMR, 0);
555 SONIC_WRITE(SONIC_ISR, 0x7fff);
557 /* Now look for the MAC address. */
558 if (mac_nubus_sonic_ethernet_addr(dev, prom_addr, id) != 0)
559 return -ENODEV;
561 /* Shared init code */
562 return macsonic_init(dev);
565 static int __init mac_sonic_probe(struct platform_device *pdev)
567 struct net_device *dev;
568 struct sonic_local *lp;
569 int err;
570 int i;
572 dev = alloc_etherdev(sizeof(struct sonic_local));
573 if (!dev)
574 return -ENOMEM;
576 lp = netdev_priv(dev);
577 lp->device = &pdev->dev;
578 SET_NETDEV_DEV(dev, &pdev->dev);
579 SET_MODULE_OWNER(dev);
581 /* This will catch fatal stuff like -ENOMEM as well as success */
582 err = mac_onboard_sonic_probe(dev);
583 if (err == 0)
584 goto found;
585 if (err != -ENODEV)
586 goto out;
587 err = mac_nubus_sonic_probe(dev);
588 if (err)
589 goto out;
590 found:
591 err = register_netdev(dev);
592 if (err)
593 goto out;
595 printk("%s: MAC ", dev->name);
596 for (i = 0; i < 6; i++) {
597 printk("%2.2x", dev->dev_addr[i]);
598 if (i < 5)
599 printk(":");
601 printk(" IRQ %d\n", dev->irq);
603 return 0;
605 out:
606 free_netdev(dev);
608 return err;
611 MODULE_DESCRIPTION("Macintosh SONIC ethernet driver");
612 module_param(sonic_debug, int, 0);
613 MODULE_PARM_DESC(sonic_debug, "macsonic debug level (1-4)");
615 #include "sonic.c"
617 static int __devexit mac_sonic_device_remove (struct platform_device *pdev)
619 struct net_device *dev = platform_get_drvdata(pdev);
620 struct sonic_local* lp = netdev_priv(dev);
622 unregister_netdev(dev);
623 dma_free_coherent(lp->device, SIZEOF_SONIC_DESC * SONIC_BUS_SCALE(lp->dma_bitmode),
624 lp->descriptors, lp->descriptors_laddr);
625 free_netdev(dev);
627 return 0;
630 static struct platform_driver mac_sonic_driver = {
631 .probe = mac_sonic_probe,
632 .remove = __devexit_p(mac_sonic_device_remove),
633 .driver = {
634 .name = mac_sonic_string,
638 static int __init mac_sonic_init_module(void)
640 int err;
642 if ((err = platform_driver_register(&mac_sonic_driver))) {
643 printk(KERN_ERR "Driver registration failed\n");
644 return err;
647 mac_sonic_device = platform_device_alloc(mac_sonic_string, 0);
648 if (!mac_sonic_device)
649 goto out_unregister;
651 if (platform_device_add(mac_sonic_device)) {
652 platform_device_put(mac_sonic_device);
653 mac_sonic_device = NULL;
656 return 0;
658 out_unregister:
659 platform_driver_unregister(&mac_sonic_driver);
661 return -ENOMEM;
664 static void __exit mac_sonic_cleanup_module(void)
666 platform_driver_unregister(&mac_sonic_driver);
668 if (mac_sonic_device) {
669 platform_device_unregister(mac_sonic_device);
670 mac_sonic_device = NULL;
674 module_init(mac_sonic_init_module);
675 module_exit(mac_sonic_cleanup_module);