drivers/net/ethernet/natsemi/macsonic.c

   1 /*
   2  * macsonic.c
   3  *
   4  * (C) 2005 Finn Thain
   5  *
   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.
   9  *
  10  * (C) 1998 Alan Cox
  11  *
  12  * Debugging Andreas Ehliar, Michael Schmitz
  13  *
  14  * Based on code
  15  * (C) 1996 by Thomas Bogendoerfer (tsbogend@bigbug.franken.de)
  16  *
  17  * This driver is based on work from Andreas Busse, but most of
  18  * the code is rewritten.
  19  *
  20  * (C) 1995 by Andreas Busse (andy@waldorf-gmbh.de)
  21  *
  22  * A driver for the Mac onboard Sonic ethernet chip.
  23  *
  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.
  27  *
  28  * 99/01/03 MSch: upgraded to version 0.92 of the core driver, fixed.
  29  *
  30  * 00/10/31 sammy@oh.verio.com: Updated driver for 2.4 kernels, fixed problems
  31  *          on centris.
  32  */
  33
  34 #include <linux/kernel.h>
  35 #include <linux/module.h>
  36 #include <linux/types.h>
  37 #include <linux/fcntl.h>
  38 #include <linux/gfp.h>
  39 #include <linux/interrupt.h>
  40 #include <linux/init.h>
  41 #include <linux/ioport.h>
  42 #include <linux/in.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>
  53 #include <linux/slab.h>
  54
  55 #include <asm/bootinfo.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>
  63
  64 static char mac_sonic_string[] = "macsonic";
  65
  66 #include "sonic.h"
  67
  68 /* These should basically be bus-size and endian independent (since
  69    the SONIC is at least smart enough that it uses the same endianness
  70    as the host, unlike certain less enlightened Macintosh NICs) */
  71 #define SONIC_READ(reg) (nubus_readw(dev->base_addr + (reg * 4) \
  72               + lp->reg_offset))
  73 #define SONIC_WRITE(reg,val) (nubus_writew(val, dev->base_addr + (reg * 4) \
  74               + lp->reg_offset))
  75
  76 /* use 0 for production, 1 for verification, >1 for debug */
  77 #ifdef SONIC_DEBUG
  78 static unsigned int sonic_debug = SONIC_DEBUG;
  79 #else
  80 static unsigned int sonic_debug = 1;
  81 #endif
  82
  83 static int sonic_version_printed;
  84
  85 /* For onboard SONIC */
  86 #define ONBOARD_SONIC_REGISTERS 0x50F0A000
  87 #define ONBOARD_SONIC_PROM_BASE 0x50f08000
  88
  89 enum macsonic_type {
  90         MACSONIC_DUODOCK,
  91         MACSONIC_APPLE,
  92         MACSONIC_APPLE16,
  93         MACSONIC_DAYNA,
  94         MACSONIC_DAYNALINK
  95 };
  96
  97 /* For the built-in SONIC in the Duo Dock */
  98 #define DUODOCK_SONIC_REGISTERS 0xe10000
  99 #define DUODOCK_SONIC_PROM_BASE 0xe12000
 100
 101 /* For Apple-style NuBus SONIC */
 102 #define APPLE_SONIC_REGISTERS   0
 103 #define APPLE_SONIC_PROM_BASE   0x40000
 104
 105 /* Daynalink LC SONIC */
 106 #define DAYNALINK_PROM_BASE 0x400000
 107
 108 /* For Dayna-style NuBus SONIC (haven't seen one yet) */
 109 #define DAYNA_SONIC_REGISTERS   0x180000
 110 /* This is what OpenBSD says.  However, this is definitely in NuBus
 111    ROM space so we should be able to get it by walking the NuBus
 112    resource directories */
 113 #define DAYNA_SONIC_MAC_ADDR    0xffe004
 114
 115 #define SONIC_READ_PROM(addr) nubus_readb(prom_addr+addr)
 116
 117 /*
 118  * For reversing the PROM address
 119  */
 120
 121 static inline void bit_reverse_addr(unsigned char addr[6])
 122 {
 123         int i;
 124
 125         for(i = 0; i < 6; i++)
 126                 addr[i] = bitrev8(addr[i]);
 127 }
 128
 129 static irqreturn_t macsonic_interrupt(int irq, void *dev_id)
 130 {
 131         irqreturn_t result;
 132         unsigned long flags;
 133
 134         local_irq_save(flags);
 135         result = sonic_interrupt(irq, dev_id);
 136         local_irq_restore(flags);
 137         return result;
 138 }
 139
 140 static int macsonic_open(struct net_device* dev)
 141 {
 142         int retval;
 143
 144         retval = request_irq(dev->irq, sonic_interrupt, 0, "sonic", dev);
 145         if (retval) {
 146                 printk(KERN_ERR "%s: unable to get IRQ %d.\n",
 147                                 dev->name, dev->irq);
 148                 goto err;
 149         }
 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.
 153          */
 154         if (dev->irq == IRQ_AUTO_3) {
 155                 retval = request_irq(IRQ_NUBUS_9, macsonic_interrupt, 0,
 156                                      "sonic", dev);
 157                 if (retval) {
 158                         printk(KERN_ERR "%s: unable to get IRQ %d.\n",
 159                                         dev->name, IRQ_NUBUS_9);
 160                         goto err_irq;
 161                 }
 162         }
 163         retval = sonic_open(dev);
 164         if (retval)
 165                 goto err_irq_nubus;
 166         return 0;
 167
 168 err_irq_nubus:
 169         if (dev->irq == IRQ_AUTO_3)
 170                 free_irq(IRQ_NUBUS_9, dev);
 171 err_irq:
 172         free_irq(dev->irq, dev);
 173 err:
 174         return retval;
 175 }
 176
 177 static int macsonic_close(struct net_device* dev)
 178 {
 179         int err;
 180         err = sonic_close(dev);
 181         free_irq(dev->irq, dev);
 182         if (dev->irq == IRQ_AUTO_3)
 183                 free_irq(IRQ_NUBUS_9, dev);
 184         return err;
 185 }
 186
 187 static const struct net_device_ops macsonic_netdev_ops = {
 188         .ndo_open               = macsonic_open,
 189         .ndo_stop               = macsonic_close,
 190         .ndo_start_xmit         = sonic_send_packet,
 191         .ndo_set_rx_mode        = sonic_multicast_list,
 192         .ndo_tx_timeout         = sonic_tx_timeout,
 193         .ndo_get_stats          = sonic_get_stats,
 194         .ndo_validate_addr      = eth_validate_addr,
 195         .ndo_change_mtu         = eth_change_mtu,
 196         .ndo_set_mac_address    = eth_mac_addr,
 197 };
 198
 199 static int macsonic_init(struct net_device *dev)
 200 {
 201         struct sonic_local* lp = netdev_priv(dev);
 202
 203         /* Allocate the entire chunk of memory for the descriptors.
 204            Note that this cannot cross a 64K boundary. */
 205         lp->descriptors = dma_alloc_coherent(lp->device,
 206                                              SIZEOF_SONIC_DESC *
 207                                              SONIC_BUS_SCALE(lp->dma_bitmode),
 208                                              &lp->descriptors_laddr,
 209                                              GFP_KERNEL);
 210         if (lp->descriptors == NULL)
 211                 return -ENOMEM;
 212
 213         /* Now set up the pointers to point to the appropriate places */
 214         lp->cda = lp->descriptors;
 215         lp->tda = lp->cda + (SIZEOF_SONIC_CDA
 216                              * SONIC_BUS_SCALE(lp->dma_bitmode));
 217         lp->rda = lp->tda + (SIZEOF_SONIC_TD * SONIC_NUM_TDS
 218                              * SONIC_BUS_SCALE(lp->dma_bitmode));
 219         lp->rra = lp->rda + (SIZEOF_SONIC_RD * SONIC_NUM_RDS
 220                              * SONIC_BUS_SCALE(lp->dma_bitmode));
 221
 222         lp->cda_laddr = lp->descriptors_laddr;
 223         lp->tda_laddr = lp->cda_laddr + (SIZEOF_SONIC_CDA
 224                              * SONIC_BUS_SCALE(lp->dma_bitmode));
 225         lp->rda_laddr = lp->tda_laddr + (SIZEOF_SONIC_TD * SONIC_NUM_TDS
 226                              * SONIC_BUS_SCALE(lp->dma_bitmode));
 227         lp->rra_laddr = lp->rda_laddr + (SIZEOF_SONIC_RD * SONIC_NUM_RDS
 228                              * SONIC_BUS_SCALE(lp->dma_bitmode));
 229
 230         dev->netdev_ops = &macsonic_netdev_ops;
 231         dev->watchdog_timeo = TX_TIMEOUT;
 232
 233         /*
 234          * clear tally counter
 235          */
 236         SONIC_WRITE(SONIC_CRCT, 0xffff);
 237         SONIC_WRITE(SONIC_FAET, 0xffff);
 238         SONIC_WRITE(SONIC_MPT, 0xffff);
 239
 240         return 0;
 241 }
 242
 243 #define INVALID_MAC(mac) (memcmp(mac, "\x08\x00\x07", 3) && \
 244                           memcmp(mac, "\x00\xA0\x40", 3) && \
 245                           memcmp(mac, "\x00\x80\x19", 3) && \
 246                           memcmp(mac, "\x00\x05\x02", 3))
 247
 248 static void mac_onboard_sonic_ethernet_addr(struct net_device *dev)
 249 {
 250         struct sonic_local *lp = netdev_priv(dev);
 251         const int prom_addr = ONBOARD_SONIC_PROM_BASE;
 252         unsigned short val;
 253
 254         /*
 255          * On NuBus boards we can sometimes look in the ROM resources.
 256          * No such luck for comm-slot/onboard.
 257          * On the PowerBook 520, the PROM base address is a mystery.
 258          */
 259         if (hwreg_present((void *)prom_addr)) {
 260                 int i;
 261
 262                 for (i = 0; i < 6; i++)
 263                         dev->dev_addr[i] = SONIC_READ_PROM(i);
 264                 if (!INVALID_MAC(dev->dev_addr))
 265                         return;
 266
 267                 /*
 268                  * Most of the time, the address is bit-reversed. The NetBSD
 269                  * source has a rather long and detailed historical account of
 270                  * why this is so.
 271                  */
 272                 bit_reverse_addr(dev->dev_addr);
 273                 if (!INVALID_MAC(dev->dev_addr))
 274                         return;
 275
 276                 /*
 277                  * If we still have what seems to be a bogus address, we'll
 278                  * look in the CAM. The top entry should be ours.
 279                  */
 280                 printk(KERN_WARNING "macsonic: MAC address in PROM seems "
 281                                     "to be invalid, trying CAM\n");
 282         } else {
 283                 printk(KERN_WARNING "macsonic: cannot read MAC address from "
 284                                     "PROM, trying CAM\n");
 285         }
 286
 287         /* This only works if MacOS has already initialized the card. */
 288
 289         SONIC_WRITE(SONIC_CMD, SONIC_CR_RST);
 290         SONIC_WRITE(SONIC_CEP, 15);
 291
 292         val = SONIC_READ(SONIC_CAP2);
 293         dev->dev_addr[5] = val >> 8;
 294         dev->dev_addr[4] = val & 0xff;
 295         val = SONIC_READ(SONIC_CAP1);
 296         dev->dev_addr[3] = val >> 8;
 297         dev->dev_addr[2] = val & 0xff;
 298         val = SONIC_READ(SONIC_CAP0);
 299         dev->dev_addr[1] = val >> 8;
 300         dev->dev_addr[0] = val & 0xff;
 301
 302         if (!INVALID_MAC(dev->dev_addr))
 303                 return;
 304
 305         /* Still nonsense ... messed up someplace! */
 306
 307         printk(KERN_WARNING "macsonic: MAC address in CAM entry 15 "
 308                             "seems invalid, will use a random MAC\n");
 309         eth_hw_addr_random(dev);
 310 }
 311
 312 static int mac_onboard_sonic_probe(struct net_device *dev)
 313 {
 314         struct sonic_local* lp = netdev_priv(dev);
 315         int sr;
 316         int commslot = 0;
 317
 318         if (!MACH_IS_MAC)
 319                 return -ENODEV;
 320
 321         printk(KERN_INFO "Checking for internal Macintosh ethernet (SONIC).. ");
 322
 323         /* Bogus probing, on the models which may or may not have
 324            Ethernet (BTW, the Ethernet *is* always at the same
 325            address, and nothing else lives there, at least if Apple's
 326            documentation is to be believed) */
 327         if (macintosh_config->ident == MAC_MODEL_Q630 ||
 328             macintosh_config->ident == MAC_MODEL_P588 ||
 329             macintosh_config->ident == MAC_MODEL_P575 ||
 330             macintosh_config->ident == MAC_MODEL_C610) {
 331                 unsigned long flags;
 332                 int card_present;
 333
 334                 local_irq_save(flags);
 335                 card_present = hwreg_present((void*)ONBOARD_SONIC_REGISTERS);
 336                 local_irq_restore(flags);
 337
 338                 if (!card_present) {
 339                         printk("none.\n");
 340                         return -ENODEV;
 341                 }
 342                 commslot = 1;
 343         }
 344
 345         printk("yes\n");
 346
 347         /* Danger!  My arms are flailing wildly!  You *must* set lp->reg_offset
 348          * and dev->base_addr before using SONIC_READ() or SONIC_WRITE() */
 349         dev->base_addr = ONBOARD_SONIC_REGISTERS;
 350         if (via_alt_mapping)
 351                 dev->irq = IRQ_AUTO_3;
 352         else
 353                 dev->irq = IRQ_NUBUS_9;
 354
 355         if (!sonic_version_printed) {
 356                 printk(KERN_INFO "%s", version);
 357                 sonic_version_printed = 1;
 358         }
 359         printk(KERN_INFO "%s: onboard / comm-slot SONIC at 0x%08lx\n",
 360                dev_name(lp->device), dev->base_addr);
 361
 362         /* The PowerBook's SONIC is 16 bit always. */
 363         if (macintosh_config->ident == MAC_MODEL_PB520) {
 364                 lp->reg_offset = 0;
 365                 lp->dma_bitmode = SONIC_BITMODE16;
 366                 sr = SONIC_READ(SONIC_SR);
 367         } else if (commslot) {
 368                 /* Some of the comm-slot cards are 16 bit.  But some
 369                    of them are not.  The 32-bit cards use offset 2 and
 370                    have known revisions, we try reading the revision
 371                    register at offset 2, if we don't get a known revision
 372                    we assume 16 bit at offset 0.  */
 373                 lp->reg_offset = 2;
 374                 lp->dma_bitmode = SONIC_BITMODE16;
 375
 376                 sr = SONIC_READ(SONIC_SR);
 377                 if (sr == 0x0004 || sr == 0x0006 || sr == 0x0100 || sr == 0x0101)
 378                         /* 83932 is 0x0004 or 0x0006, 83934 is 0x0100 or 0x0101 */
 379                         lp->dma_bitmode = SONIC_BITMODE32;
 380                 else {
 381                         lp->dma_bitmode = SONIC_BITMODE16;
 382                         lp->reg_offset = 0;
 383                         sr = SONIC_READ(SONIC_SR);
 384                 }
 385         } else {
 386                 /* All onboard cards are at offset 2 with 32 bit DMA. */
 387                 lp->reg_offset = 2;
 388                 lp->dma_bitmode = SONIC_BITMODE32;
 389                 sr = SONIC_READ(SONIC_SR);
 390         }
 391         printk(KERN_INFO
 392                "%s: revision 0x%04x, using %d bit DMA and register offset %d\n",
 393                dev_name(lp->device), sr, lp->dma_bitmode?32:16, lp->reg_offset);
 394
 395 #if 0 /* This is sometimes useful to find out how MacOS configured the card. */
 396         printk(KERN_INFO "%s: DCR: 0x%04x, DCR2: 0x%04x\n", dev_name(lp->device),
 397                SONIC_READ(SONIC_DCR) & 0xffff, SONIC_READ(SONIC_DCR2) & 0xffff);
 398 #endif
 399
 400         /* Software reset, then initialize control registers. */
 401         SONIC_WRITE(SONIC_CMD, SONIC_CR_RST);
 402
 403         SONIC_WRITE(SONIC_DCR, SONIC_DCR_EXBUS | SONIC_DCR_BMS |
 404                                SONIC_DCR_RFT1  | SONIC_DCR_TFT0 |
 405                                (lp->dma_bitmode ? SONIC_DCR_DW : 0));
 406
 407         /* This *must* be written back to in order to restore the
 408          * extended programmable output bits, as it may not have been
 409          * initialised since the hardware reset. */
 410         SONIC_WRITE(SONIC_DCR2, 0);
 411
 412         /* Clear *and* disable interrupts to be on the safe side */
 413         SONIC_WRITE(SONIC_IMR, 0);
 414         SONIC_WRITE(SONIC_ISR, 0x7fff);
 415
 416         /* Now look for the MAC address. */
 417         mac_onboard_sonic_ethernet_addr(dev);
 418
 419         /* Shared init code */
 420         return macsonic_init(dev);
 421 }
 422
 423 static int mac_nubus_sonic_ethernet_addr(struct net_device *dev,
 424                                          unsigned long prom_addr, int id)
 425 {
 426         int i;
 427         for(i = 0; i < 6; i++)
 428                 dev->dev_addr[i] = SONIC_READ_PROM(i);
 429
 430         /* Some of the addresses are bit-reversed */
 431         if (id != MACSONIC_DAYNA)
 432                 bit_reverse_addr(dev->dev_addr);
 433
 434         return 0;
 435 }
 436
 437 static int macsonic_ident(struct nubus_dev *ndev)
 438 {
 439         if (ndev->dr_hw == NUBUS_DRHW_ASANTE_LC &&
 440             ndev->dr_sw == NUBUS_DRSW_SONIC_LC)
 441                 return MACSONIC_DAYNALINK;
 442         if (ndev->dr_hw == NUBUS_DRHW_SONIC &&
 443             ndev->dr_sw == NUBUS_DRSW_APPLE) {
 444                 /* There has to be a better way to do this... */
 445                 if (strstr(ndev->board->name, "DuoDock"))
 446                         return MACSONIC_DUODOCK;
 447                 else
 448                         return MACSONIC_APPLE;
 449         }
 450
 451         if (ndev->dr_hw == NUBUS_DRHW_SMC9194 &&
 452             ndev->dr_sw == NUBUS_DRSW_DAYNA)
 453                 return MACSONIC_DAYNA;
 454
 455         if (ndev->dr_hw == NUBUS_DRHW_APPLE_SONIC_LC &&
 456             ndev->dr_sw == 0) { /* huh? */
 457                 return MACSONIC_APPLE16;
 458         }
 459         return -1;
 460 }
 461
 462 static int mac_nubus_sonic_probe(struct net_device *dev)
 463 {
 464         static int slots;
 465         struct nubus_dev* ndev = NULL;
 466         struct sonic_local* lp = netdev_priv(dev);
 467         unsigned long base_addr, prom_addr;
 468         u16 sonic_dcr;
 469         int id = -1;
 470         int reg_offset, dma_bitmode;
 471
 472         /* Find the first SONIC that hasn't been initialized already */
 473         while ((ndev = nubus_find_type(NUBUS_CAT_NETWORK,
 474                                        NUBUS_TYPE_ETHERNET, ndev)) != NULL)
 475         {
 476                 /* Have we seen it already? */
 477                 if (slots & (1<<ndev->board->slot))
 478                         continue;
 479                 slots |= 1<<ndev->board->slot;
 480
 481                 /* Is it one of ours? */
 482                 if ((id = macsonic_ident(ndev)) != -1)
 483                         break;
 484         }
 485
 486         if (ndev == NULL)
 487                 return -ENODEV;
 488
 489         switch (id) {
 490         case MACSONIC_DUODOCK:
 491                 base_addr = ndev->board->slot_addr + DUODOCK_SONIC_REGISTERS;
 492                 prom_addr = ndev->board->slot_addr + DUODOCK_SONIC_PROM_BASE;
 493                 sonic_dcr = SONIC_DCR_EXBUS | SONIC_DCR_RFT0 | SONIC_DCR_RFT1 |
 494                             SONIC_DCR_TFT0;
 495                 reg_offset = 2;
 496                 dma_bitmode = SONIC_BITMODE32;
 497                 break;
 498         case MACSONIC_APPLE:
 499                 base_addr = ndev->board->slot_addr + APPLE_SONIC_REGISTERS;
 500                 prom_addr = ndev->board->slot_addr + APPLE_SONIC_PROM_BASE;
 501                 sonic_dcr = SONIC_DCR_BMS | SONIC_DCR_RFT1 | SONIC_DCR_TFT0;
 502                 reg_offset = 0;
 503                 dma_bitmode = SONIC_BITMODE32;
 504                 break;
 505         case MACSONIC_APPLE16:
 506                 base_addr = ndev->board->slot_addr + APPLE_SONIC_REGISTERS;
 507                 prom_addr = ndev->board->slot_addr + APPLE_SONIC_PROM_BASE;
 508                 sonic_dcr = SONIC_DCR_EXBUS | SONIC_DCR_RFT1 | SONIC_DCR_TFT0 |
 509                             SONIC_DCR_PO1 | SONIC_DCR_BMS;
 510                 reg_offset = 0;
 511                 dma_bitmode = SONIC_BITMODE16;
 512                 break;
 513         case MACSONIC_DAYNALINK:
 514                 base_addr = ndev->board->slot_addr + APPLE_SONIC_REGISTERS;
 515                 prom_addr = ndev->board->slot_addr + DAYNALINK_PROM_BASE;
 516                 sonic_dcr = SONIC_DCR_RFT1 | SONIC_DCR_TFT0 |
 517                             SONIC_DCR_PO1 | SONIC_DCR_BMS;
 518                 reg_offset = 0;
 519                 dma_bitmode = SONIC_BITMODE16;
 520                 break;
 521         case MACSONIC_DAYNA:
 522                 base_addr = ndev->board->slot_addr + DAYNA_SONIC_REGISTERS;
 523                 prom_addr = ndev->board->slot_addr + DAYNA_SONIC_MAC_ADDR;
 524                 sonic_dcr = SONIC_DCR_BMS |
 525                             SONIC_DCR_RFT1 | SONIC_DCR_TFT0 | SONIC_DCR_PO1;
 526                 reg_offset = 0;
 527                 dma_bitmode = SONIC_BITMODE16;
 528                 break;
 529         default:
 530                 printk(KERN_ERR "macsonic: WTF, id is %d\n", id);
 531                 return -ENODEV;
 532         }
 533
 534         /* Danger!  My arms are flailing wildly!  You *must* set lp->reg_offset
 535          * and dev->base_addr before using SONIC_READ() or SONIC_WRITE() */
 536         dev->base_addr = base_addr;
 537         lp->reg_offset = reg_offset;
 538         lp->dma_bitmode = dma_bitmode;
 539         dev->irq = SLOT2IRQ(ndev->board->slot);
 540
 541         if (!sonic_version_printed) {
 542                 printk(KERN_INFO "%s", version);
 543                 sonic_version_printed = 1;
 544         }
 545         printk(KERN_INFO "%s: %s in slot %X\n",
 546                dev_name(lp->device), ndev->board->name, ndev->board->slot);
 547         printk(KERN_INFO "%s: revision 0x%04x, using %d bit DMA and register offset %d\n",
 548                dev_name(lp->device), SONIC_READ(SONIC_SR), dma_bitmode?32:16, reg_offset);
 549
 550 #if 0 /* This is sometimes useful to find out how MacOS configured the card. */
 551         printk(KERN_INFO "%s: DCR: 0x%04x, DCR2: 0x%04x\n", dev_name(lp->device),
 552                SONIC_READ(SONIC_DCR) & 0xffff, SONIC_READ(SONIC_DCR2) & 0xffff);
 553 #endif
 554
 555         /* Software reset, then initialize control registers. */
 556         SONIC_WRITE(SONIC_CMD, SONIC_CR_RST);
 557         SONIC_WRITE(SONIC_DCR, sonic_dcr | (dma_bitmode ? SONIC_DCR_DW : 0));
 558         /* This *must* be written back to in order to restore the
 559          * extended programmable output bits, since it may not have been
 560          * initialised since the hardware reset. */
 561         SONIC_WRITE(SONIC_DCR2, 0);
 562
 563         /* Clear *and* disable interrupts to be on the safe side */
 564         SONIC_WRITE(SONIC_IMR, 0);
 565         SONIC_WRITE(SONIC_ISR, 0x7fff);
 566
 567         /* Now look for the MAC address. */
 568         if (mac_nubus_sonic_ethernet_addr(dev, prom_addr, id) != 0)
 569                 return -ENODEV;
 570
 571         /* Shared init code */
 572         return macsonic_init(dev);
 573 }
 574
 575 static int mac_sonic_probe(struct platform_device *pdev)
 576 {
 577         struct net_device *dev;
 578         struct sonic_local *lp;
 579         int err;
 580
 581         dev = alloc_etherdev(sizeof(struct sonic_local));
 582         if (!dev)
 583                 return -ENOMEM;
 584
 585         lp = netdev_priv(dev);
 586         lp->device = &pdev->dev;
 587         SET_NETDEV_DEV(dev, &pdev->dev);
 588         platform_set_drvdata(pdev, dev);
 589
 590         /* This will catch fatal stuff like -ENOMEM as well as success */
 591         err = mac_onboard_sonic_probe(dev);
 592         if (err == 0)
 593                 goto found;
 594         if (err != -ENODEV)
 595                 goto out;
 596         err = mac_nubus_sonic_probe(dev);
 597         if (err)
 598                 goto out;
 599 found:
 600         err = register_netdev(dev);
 601         if (err)
 602                 goto out;
 603
 604         printk("%s: MAC %pM IRQ %d\n", dev->name, dev->dev_addr, dev->irq);
 605
 606         return 0;
 607
 608 out:
 609         free_netdev(dev);
 610
 611         return err;
 612 }
 613
 614 MODULE_DESCRIPTION("Macintosh SONIC ethernet driver");
 615 module_param(sonic_debug, int, 0);
 616 MODULE_PARM_DESC(sonic_debug, "macsonic debug level (1-4)");
 617 MODULE_ALIAS("platform:macsonic");
 618
 619 #include "sonic.c"
 620
 621 static int mac_sonic_device_remove(struct platform_device *pdev)
 622 {
 623         struct net_device *dev = platform_get_drvdata(pdev);
 624         struct sonic_local* lp = netdev_priv(dev);
 625
 626         unregister_netdev(dev);
 627         dma_free_coherent(lp->device, SIZEOF_SONIC_DESC * SONIC_BUS_SCALE(lp->dma_bitmode),
 628                           lp->descriptors, lp->descriptors_laddr);
 629         free_netdev(dev);
 630
 631         return 0;
 632 }
 633
 634 static struct platform_driver mac_sonic_driver = {
 635         .probe  = mac_sonic_probe,
 636         .remove = mac_sonic_device_remove,
 637         .driver = {
 638                 .name   = mac_sonic_string,
 639                 .owner  = THIS_MODULE,
 640         },
 641 };
 642
 643 module_platform_driver(mac_sonic_driver);