linux/drivers/net/arm/etherh.c
<<
>>
Prefs
   1/*
   2 *  linux/drivers/acorn/net/etherh.c
   3 *
   4 *  Copyright (C) 2000-2002 Russell King
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License version 2 as
   8 * published by the Free Software Foundation.
   9 *
  10 * NS8390 I-cubed EtherH and ANT EtherM specific driver
  11 * Thanks to I-Cubed for information on their cards.
  12 * EtherM conversion (C) 1999 Chris Kemp and Tim Watterton
  13 * EtherM integration (C) 2000 Aleph One Ltd (Tak-Shing Chan)
  14 * EtherM integration re-engineered by Russell King.
  15 *
  16 * Changelog:
  17 *  08-12-1996  RMK     1.00    Created
  18 *              RMK     1.03    Added support for EtherLan500 cards
  19 *  23-11-1997  RMK     1.04    Added media autodetection
  20 *  16-04-1998  RMK     1.05    Improved media autodetection
  21 *  10-02-2000  RMK     1.06    Updated for 2.3.43
  22 *  13-05-2000  RMK     1.07    Updated for 2.3.99-pre8
  23 *  12-10-1999  CK/TEW          EtherM driver first release
  24 *  21-12-2000  TTC             EtherH/EtherM integration
  25 *  25-12-2000  RMK     1.08    Clean integration of EtherM into this driver.
  26 *  03-01-2002  RMK     1.09    Always enable IRQs if we're in the nic slot.
  27 */
  28
  29#include <linux/module.h>
  30#include <linux/kernel.h>
  31#include <linux/types.h>
  32#include <linux/fcntl.h>
  33#include <linux/interrupt.h>
  34#include <linux/ioport.h>
  35#include <linux/in.h>
  36#include <linux/string.h>
  37#include <linux/errno.h>
  38#include <linux/netdevice.h>
  39#include <linux/etherdevice.h>
  40#include <linux/ethtool.h>
  41#include <linux/skbuff.h>
  42#include <linux/delay.h>
  43#include <linux/device.h>
  44#include <linux/init.h>
  45#include <linux/bitops.h>
  46#include <linux/jiffies.h>
  47
  48#include <asm/system.h>
  49#include <asm/ecard.h>
  50#include <asm/io.h>
  51
  52#define EI_SHIFT(x)     (ei_local->reg_offset[x])
  53
  54#define ei_inb(_p)       readb((void __iomem *)_p)
  55#define ei_outb(_v,_p)   writeb(_v,(void __iomem *)_p)
  56#define ei_inb_p(_p)     readb((void __iomem *)_p)
  57#define ei_outb_p(_v,_p) writeb(_v,(void __iomem *)_p)
  58
  59#define NET_DEBUG  0
  60#define DEBUG_INIT 2
  61
  62#define DRV_NAME        "etherh"
  63#define DRV_VERSION     "1.11"
  64
  65static char version[] __initdata =
  66        "EtherH/EtherM Driver (c) 2002-2004 Russell King " DRV_VERSION "\n";
  67
  68#include "../lib8390.c"
  69
  70static unsigned int net_debug = NET_DEBUG;
  71
  72struct etherh_priv {
  73        void __iomem    *ioc_fast;
  74        void __iomem    *memc;
  75        void __iomem    *dma_base;
  76        unsigned int    id;
  77        void __iomem    *ctrl_port;
  78        unsigned char   ctrl;
  79        u32             supported;
  80};
  81
  82struct etherh_data {
  83        unsigned long   ns8390_offset;
  84        unsigned long   dataport_offset;
  85        unsigned long   ctrlport_offset;
  86        int             ctrl_ioc;
  87        const char      name[16];
  88        u32             supported;
  89        unsigned char   tx_start_page;
  90        unsigned char   stop_page;
  91};
  92
  93MODULE_AUTHOR("Russell King");
  94MODULE_DESCRIPTION("EtherH/EtherM driver");
  95MODULE_LICENSE("GPL");
  96
  97#define ETHERH500_DATAPORT      0x800   /* MEMC */
  98#define ETHERH500_NS8390        0x000   /* MEMC */
  99#define ETHERH500_CTRLPORT      0x800   /* IOC  */
 100
 101#define ETHERH600_DATAPORT      0x040   /* MEMC */
 102#define ETHERH600_NS8390        0x800   /* MEMC */
 103#define ETHERH600_CTRLPORT      0x200   /* MEMC */
 104
 105#define ETHERH_CP_IE            1
 106#define ETHERH_CP_IF            2
 107#define ETHERH_CP_HEARTBEAT     2
 108
 109#define ETHERH_TX_START_PAGE    1
 110#define ETHERH_STOP_PAGE        127
 111
 112/*
 113 * These came from CK/TEW
 114 */
 115#define ETHERM_DATAPORT         0x200   /* MEMC */
 116#define ETHERM_NS8390           0x800   /* MEMC */
 117#define ETHERM_CTRLPORT         0x23c   /* MEMC */
 118
 119#define ETHERM_TX_START_PAGE    64
 120#define ETHERM_STOP_PAGE        127
 121
 122/* ------------------------------------------------------------------------ */
 123
 124#define etherh_priv(dev) \
 125 ((struct etherh_priv *)(((char *)netdev_priv(dev)) + sizeof(struct ei_device)))
 126
 127static inline void etherh_set_ctrl(struct etherh_priv *eh, unsigned char mask)
 128{
 129        unsigned char ctrl = eh->ctrl | mask;
 130        eh->ctrl = ctrl;
 131        writeb(ctrl, eh->ctrl_port);
 132}
 133
 134static inline void etherh_clr_ctrl(struct etherh_priv *eh, unsigned char mask)
 135{
 136        unsigned char ctrl = eh->ctrl & ~mask;
 137        eh->ctrl = ctrl;
 138        writeb(ctrl, eh->ctrl_port);
 139}
 140
 141static inline unsigned int etherh_get_stat(struct etherh_priv *eh)
 142{
 143        return readb(eh->ctrl_port);
 144}
 145
 146
 147
 148
 149static void etherh_irq_enable(ecard_t *ec, int irqnr)
 150{
 151        struct etherh_priv *eh = ec->irq_data;
 152
 153        etherh_set_ctrl(eh, ETHERH_CP_IE);
 154}
 155
 156static void etherh_irq_disable(ecard_t *ec, int irqnr)
 157{
 158        struct etherh_priv *eh = ec->irq_data;
 159
 160        etherh_clr_ctrl(eh, ETHERH_CP_IE);
 161}
 162
 163static expansioncard_ops_t etherh_ops = {
 164        .irqenable      = etherh_irq_enable,
 165        .irqdisable     = etherh_irq_disable,
 166};
 167
 168
 169
 170
 171static void
 172etherh_setif(struct net_device *dev)
 173{
 174        struct ei_device *ei_local = netdev_priv(dev);
 175        unsigned long flags;
 176        void __iomem *addr;
 177
 178        local_irq_save(flags);
 179
 180        /* set the interface type */
 181        switch (etherh_priv(dev)->id) {
 182        case PROD_I3_ETHERLAN600:
 183        case PROD_I3_ETHERLAN600A:
 184                addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
 185
 186                switch (dev->if_port) {
 187                case IF_PORT_10BASE2:
 188                        writeb((readb(addr) & 0xf8) | 1, addr);
 189                        break;
 190                case IF_PORT_10BASET:
 191                        writeb((readb(addr) & 0xf8), addr);
 192                        break;
 193                }
 194                break;
 195
 196        case PROD_I3_ETHERLAN500:
 197                switch (dev->if_port) {
 198                case IF_PORT_10BASE2:
 199                        etherh_clr_ctrl(etherh_priv(dev), ETHERH_CP_IF);
 200                        break;
 201
 202                case IF_PORT_10BASET:
 203                        etherh_set_ctrl(etherh_priv(dev), ETHERH_CP_IF);
 204                        break;
 205                }
 206                break;
 207
 208        default:
 209                break;
 210        }
 211
 212        local_irq_restore(flags);
 213}
 214
 215static int
 216etherh_getifstat(struct net_device *dev)
 217{
 218        struct ei_device *ei_local = netdev_priv(dev);
 219        void __iomem *addr;
 220        int stat = 0;
 221
 222        switch (etherh_priv(dev)->id) {
 223        case PROD_I3_ETHERLAN600:
 224        case PROD_I3_ETHERLAN600A:
 225                addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
 226                switch (dev->if_port) {
 227                case IF_PORT_10BASE2:
 228                        stat = 1;
 229                        break;
 230                case IF_PORT_10BASET:
 231                        stat = readb(addr) & 4;
 232                        break;
 233                }
 234                break;
 235
 236        case PROD_I3_ETHERLAN500:
 237                switch (dev->if_port) {
 238                case IF_PORT_10BASE2:
 239                        stat = 1;
 240                        break;
 241                case IF_PORT_10BASET:
 242                        stat = etherh_get_stat(etherh_priv(dev)) & ETHERH_CP_HEARTBEAT;
 243                        break;
 244                }
 245                break;
 246
 247        default:
 248                stat = 0;
 249                break;
 250        }
 251
 252        return stat != 0;
 253}
 254
 255/*
 256 * Configure the interface.  Note that we ignore the other
 257 * parts of ifmap, since its mostly meaningless for this driver.
 258 */
 259static int etherh_set_config(struct net_device *dev, struct ifmap *map)
 260{
 261        switch (map->port) {
 262        case IF_PORT_10BASE2:
 263        case IF_PORT_10BASET:
 264                /*
 265                 * If the user explicitly sets the interface
 266                 * media type, turn off automedia detection.
 267                 */
 268                dev->flags &= ~IFF_AUTOMEDIA;
 269                dev->if_port = map->port;
 270                break;
 271
 272        default:
 273                return -EINVAL;
 274        }
 275
 276        etherh_setif(dev);
 277
 278        return 0;
 279}
 280
 281/*
 282 * Reset the 8390 (hard reset).  Note that we can't actually do this.
 283 */
 284static void
 285etherh_reset(struct net_device *dev)
 286{
 287        struct ei_device *ei_local = netdev_priv(dev);
 288        void __iomem *addr = (void __iomem *)dev->base_addr;
 289
 290        writeb(E8390_NODMA+E8390_PAGE0+E8390_STOP, addr);
 291
 292        /*
 293         * See if we need to change the interface type.
 294         * Note that we use 'interface_num' as a flag
 295         * to indicate that we need to change the media.
 296         */
 297        if (dev->flags & IFF_AUTOMEDIA && ei_local->interface_num) {
 298                ei_local->interface_num = 0;
 299
 300                if (dev->if_port == IF_PORT_10BASET)
 301                        dev->if_port = IF_PORT_10BASE2;
 302                else
 303                        dev->if_port = IF_PORT_10BASET;
 304
 305                etherh_setif(dev);
 306        }
 307}
 308
 309/*
 310 * Write a block of data out to the 8390
 311 */
 312static void
 313etherh_block_output (struct net_device *dev, int count, const unsigned char *buf, int start_page)
 314{
 315        struct ei_device *ei_local = netdev_priv(dev);
 316        unsigned long dma_start;
 317        void __iomem *dma_base, *addr;
 318
 319        if (ei_local->dmaing) {
 320                printk(KERN_ERR "%s: DMAing conflict in etherh_block_input: "
 321                        " DMAstat %d irqlock %d\n", dev->name,
 322                        ei_local->dmaing, ei_local->irqlock);
 323                return;
 324        }
 325
 326        /*
 327         * Make sure we have a round number of bytes if we're in word mode.
 328         */
 329        if (count & 1 && ei_local->word16)
 330                count++;
 331
 332        ei_local->dmaing = 1;
 333
 334        addr = (void __iomem *)dev->base_addr;
 335        dma_base = etherh_priv(dev)->dma_base;
 336
 337        count = (count + 1) & ~1;
 338        writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
 339
 340        writeb (0x42, addr + EN0_RCNTLO);
 341        writeb (0x00, addr + EN0_RCNTHI);
 342        writeb (0x42, addr + EN0_RSARLO);
 343        writeb (0x00, addr + EN0_RSARHI);
 344        writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
 345
 346        udelay (1);
 347
 348        writeb (ENISR_RDC, addr + EN0_ISR);
 349        writeb (count, addr + EN0_RCNTLO);
 350        writeb (count >> 8, addr + EN0_RCNTHI);
 351        writeb (0, addr + EN0_RSARLO);
 352        writeb (start_page, addr + EN0_RSARHI);
 353        writeb (E8390_RWRITE | E8390_START, addr + E8390_CMD);
 354
 355        if (ei_local->word16)
 356                writesw (dma_base, buf, count >> 1);
 357        else
 358                writesb (dma_base, buf, count);
 359
 360        dma_start = jiffies;
 361
 362        while ((readb (addr + EN0_ISR) & ENISR_RDC) == 0)
 363                if (time_after(jiffies, dma_start + 2*HZ/100)) { /* 20ms */
 364                        printk(KERN_ERR "%s: timeout waiting for TX RDC\n",
 365                                dev->name);
 366                        etherh_reset (dev);
 367                        __NS8390_init (dev, 1);
 368                        break;
 369                }
 370
 371        writeb (ENISR_RDC, addr + EN0_ISR);
 372        ei_local->dmaing = 0;
 373}
 374
 375/*
 376 * Read a block of data from the 8390
 377 */
 378static void
 379etherh_block_input (struct net_device *dev, int count, struct sk_buff *skb, int ring_offset)
 380{
 381        struct ei_device *ei_local = netdev_priv(dev);
 382        unsigned char *buf;
 383        void __iomem *dma_base, *addr;
 384
 385        if (ei_local->dmaing) {
 386                printk(KERN_ERR "%s: DMAing conflict in etherh_block_input: "
 387                        " DMAstat %d irqlock %d\n", dev->name,
 388                        ei_local->dmaing, ei_local->irqlock);
 389                return;
 390        }
 391
 392        ei_local->dmaing = 1;
 393
 394        addr = (void __iomem *)dev->base_addr;
 395        dma_base = etherh_priv(dev)->dma_base;
 396
 397        buf = skb->data;
 398        writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
 399        writeb (count, addr + EN0_RCNTLO);
 400        writeb (count >> 8, addr + EN0_RCNTHI);
 401        writeb (ring_offset, addr + EN0_RSARLO);
 402        writeb (ring_offset >> 8, addr + EN0_RSARHI);
 403        writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
 404
 405        if (ei_local->word16) {
 406                readsw (dma_base, buf, count >> 1);
 407                if (count & 1)
 408                        buf[count - 1] = readb (dma_base);
 409        } else
 410                readsb (dma_base, buf, count);
 411
 412        writeb (ENISR_RDC, addr + EN0_ISR);
 413        ei_local->dmaing = 0;
 414}
 415
 416/*
 417 * Read a header from the 8390
 418 */
 419static void
 420etherh_get_header (struct net_device *dev, struct e8390_pkt_hdr *hdr, int ring_page)
 421{
 422        struct ei_device *ei_local = netdev_priv(dev);
 423        void __iomem *dma_base, *addr;
 424
 425        if (ei_local->dmaing) {
 426                printk(KERN_ERR "%s: DMAing conflict in etherh_get_header: "
 427                        " DMAstat %d irqlock %d\n", dev->name,
 428                        ei_local->dmaing, ei_local->irqlock);
 429                return;
 430        }
 431
 432        ei_local->dmaing = 1;
 433
 434        addr = (void __iomem *)dev->base_addr;
 435        dma_base = etherh_priv(dev)->dma_base;
 436
 437        writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
 438        writeb (sizeof (*hdr), addr + EN0_RCNTLO);
 439        writeb (0, addr + EN0_RCNTHI);
 440        writeb (0, addr + EN0_RSARLO);
 441        writeb (ring_page, addr + EN0_RSARHI);
 442        writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
 443
 444        if (ei_local->word16)
 445                readsw (dma_base, hdr, sizeof (*hdr) >> 1);
 446        else
 447                readsb (dma_base, hdr, sizeof (*hdr));
 448
 449        writeb (ENISR_RDC, addr + EN0_ISR);
 450        ei_local->dmaing = 0;
 451}
 452
 453/*
 454 * Open/initialize the board.  This is called (in the current kernel)
 455 * sometime after booting when the 'ifconfig' program is run.
 456 *
 457 * This routine should set everything up anew at each open, even
 458 * registers that "should" only need to be set once at boot, so that
 459 * there is non-reboot way to recover if something goes wrong.
 460 */
 461static int
 462etherh_open(struct net_device *dev)
 463{
 464        struct ei_device *ei_local = netdev_priv(dev);
 465
 466        if (!is_valid_ether_addr(dev->dev_addr)) {
 467                printk(KERN_WARNING "%s: invalid ethernet MAC address\n",
 468                        dev->name);
 469                return -EINVAL;
 470        }
 471
 472        if (request_irq(dev->irq, __ei_interrupt, 0, dev->name, dev))
 473                return -EAGAIN;
 474
 475        /*
 476         * Make sure that we aren't going to change the
 477         * media type on the next reset - we are about to
 478         * do automedia manually now.
 479         */
 480        ei_local->interface_num = 0;
 481
 482        /*
 483         * If we are doing automedia detection, do it now.
 484         * This is more reliable than the 8390's detection.
 485         */
 486        if (dev->flags & IFF_AUTOMEDIA) {
 487                dev->if_port = IF_PORT_10BASET;
 488                etherh_setif(dev);
 489                mdelay(1);
 490                if (!etherh_getifstat(dev)) {
 491                        dev->if_port = IF_PORT_10BASE2;
 492                        etherh_setif(dev);
 493                }
 494        } else
 495                etherh_setif(dev);
 496
 497        etherh_reset(dev);
 498        __ei_open(dev);
 499
 500        return 0;
 501}
 502
 503/*
 504 * The inverse routine to etherh_open().
 505 */
 506static int
 507etherh_close(struct net_device *dev)
 508{
 509        __ei_close (dev);
 510        free_irq (dev->irq, dev);
 511        return 0;
 512}
 513
 514/*
 515 * Initialisation
 516 */
 517
 518static void __init etherh_banner(void)
 519{
 520        static int version_printed;
 521
 522        if (net_debug && version_printed++ == 0)
 523                printk(KERN_INFO "%s", version);
 524}
 525
 526/*
 527 * Read the ethernet address string from the on board rom.
 528 * This is an ascii string...
 529 */
 530static int __devinit etherh_addr(char *addr, struct expansion_card *ec)
 531{
 532        struct in_chunk_dir cd;
 533        char *s;
 534        
 535        if (!ecard_readchunk(&cd, ec, 0xf5, 0)) {
 536                printk(KERN_ERR "%s: unable to read podule description string\n",
 537                       dev_name(&ec->dev));
 538                goto no_addr;
 539        }
 540
 541        s = strchr(cd.d.string, '(');
 542        if (s) {
 543                int i;
 544
 545                for (i = 0; i < 6; i++) {
 546                        addr[i] = simple_strtoul(s + 1, &s, 0x10);
 547                        if (*s != (i == 5? ')' : ':'))
 548                                break;
 549                }
 550
 551                if (i == 6)
 552                        return 0;
 553        }
 554
 555        printk(KERN_ERR "%s: unable to parse MAC address: %s\n",
 556               dev_name(&ec->dev), cd.d.string);
 557
 558 no_addr:
 559        return -ENODEV;
 560}
 561
 562/*
 563 * Create an ethernet address from the system serial number.
 564 */
 565static int __init etherm_addr(char *addr)
 566{
 567        unsigned int serial;
 568
 569        if (system_serial_low == 0 && system_serial_high == 0)
 570                return -ENODEV;
 571
 572        serial = system_serial_low | system_serial_high;
 573
 574        addr[0] = 0;
 575        addr[1] = 0;
 576        addr[2] = 0xa4;
 577        addr[3] = 0x10 + (serial >> 24);
 578        addr[4] = serial >> 16;
 579        addr[5] = serial >> 8;
 580        return 0;
 581}
 582
 583static void etherh_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
 584{
 585        strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
 586        strlcpy(info->version, DRV_VERSION, sizeof(info->version));
 587        strlcpy(info->bus_info, dev_name(dev->dev.parent),
 588                sizeof(info->bus_info));
 589}
 590
 591static int etherh_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 592{
 593        cmd->supported  = etherh_priv(dev)->supported;
 594        cmd->speed      = SPEED_10;
 595        cmd->duplex     = DUPLEX_HALF;
 596        cmd->port       = dev->if_port == IF_PORT_10BASET ? PORT_TP : PORT_BNC;
 597        cmd->autoneg    = dev->flags & IFF_AUTOMEDIA ? AUTONEG_ENABLE : AUTONEG_DISABLE;
 598        return 0;
 599}
 600
 601static int etherh_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 602{
 603        switch (cmd->autoneg) {
 604        case AUTONEG_ENABLE:
 605                dev->flags |= IFF_AUTOMEDIA;
 606                break;
 607
 608        case AUTONEG_DISABLE:
 609                switch (cmd->port) {
 610                case PORT_TP:
 611                        dev->if_port = IF_PORT_10BASET;
 612                        break;
 613
 614                case PORT_BNC:
 615                        dev->if_port = IF_PORT_10BASE2;
 616                        break;
 617
 618                default:
 619                        return -EINVAL;
 620                }
 621                dev->flags &= ~IFF_AUTOMEDIA;
 622                break;
 623
 624        default:
 625                return -EINVAL;
 626        }
 627
 628        etherh_setif(dev);
 629
 630        return 0;
 631}
 632
 633static const struct ethtool_ops etherh_ethtool_ops = {
 634        .get_settings   = etherh_get_settings,
 635        .set_settings   = etherh_set_settings,
 636        .get_drvinfo    = etherh_get_drvinfo,
 637};
 638
 639static const struct net_device_ops etherh_netdev_ops = {
 640        .ndo_open               = etherh_open,
 641        .ndo_stop               = etherh_close,
 642        .ndo_set_config         = etherh_set_config,
 643        .ndo_start_xmit         = __ei_start_xmit,
 644        .ndo_tx_timeout         = __ei_tx_timeout,
 645        .ndo_get_stats          = __ei_get_stats,
 646        .ndo_set_multicast_list = __ei_set_multicast_list,
 647        .ndo_validate_addr      = eth_validate_addr,
 648        .ndo_set_mac_address    = eth_mac_addr,
 649        .ndo_change_mtu         = eth_change_mtu,
 650#ifdef CONFIG_NET_POLL_CONTROLLER
 651        .ndo_poll_controller    = __ei_poll,
 652#endif
 653};
 654
 655static u32 etherh_regoffsets[16];
 656static u32 etherm_regoffsets[16];
 657
 658static int __devinit
 659etherh_probe(struct expansion_card *ec, const struct ecard_id *id)
 660{
 661        const struct etherh_data *data = id->data;
 662        struct ei_device *ei_local;
 663        struct net_device *dev;
 664        struct etherh_priv *eh;
 665        int ret;
 666
 667        etherh_banner();
 668
 669        ret = ecard_request_resources(ec);
 670        if (ret)
 671                goto out;
 672
 673        dev = ____alloc_ei_netdev(sizeof(struct etherh_priv));
 674        if (!dev) {
 675                ret = -ENOMEM;
 676                goto release;
 677        }
 678
 679        SET_NETDEV_DEV(dev, &ec->dev);
 680
 681        dev->netdev_ops         = &etherh_netdev_ops;
 682        dev->irq                = ec->irq;
 683        dev->ethtool_ops        = &etherh_ethtool_ops;
 684
 685        if (data->supported & SUPPORTED_Autoneg)
 686                dev->flags |= IFF_AUTOMEDIA;
 687        if (data->supported & SUPPORTED_TP) {
 688                dev->flags |= IFF_PORTSEL;
 689                dev->if_port = IF_PORT_10BASET;
 690        } else if (data->supported & SUPPORTED_BNC) {
 691                dev->flags |= IFF_PORTSEL;
 692                dev->if_port = IF_PORT_10BASE2;
 693        } else
 694                dev->if_port = IF_PORT_UNKNOWN;
 695
 696        eh = etherh_priv(dev);
 697        eh->supported           = data->supported;
 698        eh->ctrl                = 0;
 699        eh->id                  = ec->cid.product;
 700        eh->memc                = ecardm_iomap(ec, ECARD_RES_MEMC, 0, PAGE_SIZE);
 701        if (!eh->memc) {
 702                ret = -ENOMEM;
 703                goto free;
 704        }
 705
 706        eh->ctrl_port = eh->memc;
 707        if (data->ctrl_ioc) {
 708                eh->ioc_fast = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, PAGE_SIZE);
 709                if (!eh->ioc_fast) {
 710                        ret = -ENOMEM;
 711                        goto free;
 712                }
 713                eh->ctrl_port = eh->ioc_fast;
 714        }
 715
 716        dev->base_addr = (unsigned long)eh->memc + data->ns8390_offset;
 717        eh->dma_base = eh->memc + data->dataport_offset;
 718        eh->ctrl_port += data->ctrlport_offset;
 719
 720        /*
 721         * IRQ and control port handling - only for non-NIC slot cards.
 722         */
 723        if (ec->slot_no != 8) {
 724                ecard_setirq(ec, &etherh_ops, eh);
 725        } else {
 726                /*
 727                 * If we're in the NIC slot, make sure the IRQ is enabled
 728                 */
 729                etherh_set_ctrl(eh, ETHERH_CP_IE);
 730        }
 731
 732        ei_local = netdev_priv(dev);
 733        spin_lock_init(&ei_local->page_lock);
 734
 735        if (ec->cid.product == PROD_ANT_ETHERM) {
 736                etherm_addr(dev->dev_addr);
 737                ei_local->reg_offset = etherm_regoffsets;
 738        } else {
 739                etherh_addr(dev->dev_addr, ec);
 740                ei_local->reg_offset = etherh_regoffsets;
 741        }
 742
 743        ei_local->name          = dev->name;
 744        ei_local->word16        = 1;
 745        ei_local->tx_start_page = data->tx_start_page;
 746        ei_local->rx_start_page = ei_local->tx_start_page + TX_PAGES;
 747        ei_local->stop_page     = data->stop_page;
 748        ei_local->reset_8390    = etherh_reset;
 749        ei_local->block_input   = etherh_block_input;
 750        ei_local->block_output  = etherh_block_output;
 751        ei_local->get_8390_hdr  = etherh_get_header;
 752        ei_local->interface_num = 0;
 753
 754        etherh_reset(dev);
 755        __NS8390_init(dev, 0);
 756
 757        ret = register_netdev(dev);
 758        if (ret)
 759                goto free;
 760
 761        printk(KERN_INFO "%s: %s in slot %d, %pM\n",
 762                dev->name, data->name, ec->slot_no, dev->dev_addr);
 763
 764        ecard_set_drvdata(ec, dev);
 765
 766        return 0;
 767
 768 free:
 769        free_netdev(dev);
 770 release:
 771        ecard_release_resources(ec);
 772 out:
 773        return ret;
 774}
 775
 776static void __devexit etherh_remove(struct expansion_card *ec)
 777{
 778        struct net_device *dev = ecard_get_drvdata(ec);
 779
 780        ecard_set_drvdata(ec, NULL);
 781
 782        unregister_netdev(dev);
 783
 784        free_netdev(dev);
 785
 786        ecard_release_resources(ec);
 787}
 788
 789static struct etherh_data etherm_data = {
 790        .ns8390_offset          = ETHERM_NS8390,
 791        .dataport_offset        = ETHERM_NS8390 + ETHERM_DATAPORT,
 792        .ctrlport_offset        = ETHERM_NS8390 + ETHERM_CTRLPORT,
 793        .name                   = "ANT EtherM",
 794        .supported              = SUPPORTED_10baseT_Half,
 795        .tx_start_page          = ETHERM_TX_START_PAGE,
 796        .stop_page              = ETHERM_STOP_PAGE,
 797};
 798
 799static struct etherh_data etherlan500_data = {
 800        .ns8390_offset          = ETHERH500_NS8390,
 801        .dataport_offset        = ETHERH500_NS8390 + ETHERH500_DATAPORT,
 802        .ctrlport_offset        = ETHERH500_CTRLPORT,
 803        .ctrl_ioc               = 1,
 804        .name                   = "i3 EtherH 500",
 805        .supported              = SUPPORTED_10baseT_Half,
 806        .tx_start_page          = ETHERH_TX_START_PAGE,
 807        .stop_page              = ETHERH_STOP_PAGE,
 808};
 809
 810static struct etherh_data etherlan600_data = {
 811        .ns8390_offset          = ETHERH600_NS8390,
 812        .dataport_offset        = ETHERH600_NS8390 + ETHERH600_DATAPORT,
 813        .ctrlport_offset        = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
 814        .name                   = "i3 EtherH 600",
 815        .supported              = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
 816        .tx_start_page          = ETHERH_TX_START_PAGE,
 817        .stop_page              = ETHERH_STOP_PAGE,
 818};
 819
 820static struct etherh_data etherlan600a_data = {
 821        .ns8390_offset          = ETHERH600_NS8390,
 822        .dataport_offset        = ETHERH600_NS8390 + ETHERH600_DATAPORT,
 823        .ctrlport_offset        = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
 824        .name                   = "i3 EtherH 600A",
 825        .supported              = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
 826        .tx_start_page          = ETHERH_TX_START_PAGE,
 827        .stop_page              = ETHERH_STOP_PAGE,
 828};
 829
 830static const struct ecard_id etherh_ids[] = {
 831        { MANU_ANT, PROD_ANT_ETHERM,      &etherm_data       },
 832        { MANU_I3,  PROD_I3_ETHERLAN500,  &etherlan500_data  },
 833        { MANU_I3,  PROD_I3_ETHERLAN600,  &etherlan600_data  },
 834        { MANU_I3,  PROD_I3_ETHERLAN600A, &etherlan600a_data },
 835        { 0xffff,   0xffff }
 836};
 837
 838static struct ecard_driver etherh_driver = {
 839        .probe          = etherh_probe,
 840        .remove         = __devexit_p(etherh_remove),
 841        .id_table       = etherh_ids,
 842        .drv = {
 843                .name   = DRV_NAME,
 844        },
 845};
 846
 847static int __init etherh_init(void)
 848{
 849        int i;
 850
 851        for (i = 0; i < 16; i++) {
 852                etherh_regoffsets[i] = i << 2;
 853                etherm_regoffsets[i] = i << 5;
 854        }
 855
 856        return ecard_register_driver(&etherh_driver);
 857}
 858
 859static void __exit etherh_exit(void)
 860{
 861        ecard_remove_driver(&etherh_driver);
 862}
 863
 864module_init(etherh_init);
 865module_exit(etherh_exit);
 866