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