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