git.oblomov.eu Git - linux-2.6/blob - drivers/net/arm/etherh.c

   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
  66 static char version[] __initdata =
  67         "EtherH/EtherM Driver (c) 2002-2004 Russell King " DRV_VERSION "\n";
  68
  69 #include "../lib8390.c"
  70
  71 static unsigned int net_debug = NET_DEBUG;
  72
  73 struct 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
  83 struct 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
  94 MODULE_AUTHOR("Russell King");
  95 MODULE_DESCRIPTION("EtherH/EtherM driver");
  96 MODULE_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
 128 static 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
 135 static 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
 142 static inline unsigned int etherh_get_stat(struct etherh_priv *eh)
 143 {
 144         return readb(eh->ctrl_port);
 145 }
 146
 147
 148
 149
 150 static 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
 157 static 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
 164 static expansioncard_ops_t etherh_ops = {
 165         .irqenable      = etherh_irq_enable,
 166         .irqdisable     = etherh_irq_disable,
 167 };
 168
 169
 170
 171
 172 static void
 173 etherh_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
 216 static int
 217 etherh_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  */
 260 static 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  */
 285 static void
 286 etherh_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  */
 313 static void
 314 etherh_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  */
 379 static void
 380 etherh_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  */
 420 static void
 421 etherh_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  */
 462 static int
 463 etherh_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  */
 507 static int
 508 etherh_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
 519 static 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  */
 531 static 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                        ec->dev.bus_id);
 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                ec->dev.bus_id, cd.d.string);
 558
 559  no_addr:
 560         return -ENODEV;
 561 }
 562
 563 /*
 564  * Create an ethernet address from the system serial number.
 565  */
 566 static 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
 584 static 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->dev.parent->bus_id,
 589                 sizeof(info->bus_info));
 590 }
 591
 592 static 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
 602 static 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
 634 static 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
 640 static u32 etherh_regoffsets[16];
 641 static u32 etherm_regoffsets[16];
 642
 643 static int __init
 644 etherh_probe(struct expansion_card *ec, const struct ecard_id *id)
 645 {
 646         const struct etherh_data *data = id->data;
 647         struct ei_device *ei_local;
 648         struct net_device *dev;
 649         struct etherh_priv *eh;
 650         int i, ret;
 651
 652         etherh_banner();
 653
 654         ret = ecard_request_resources(ec);
 655         if (ret)
 656                 goto out;
 657
 658         dev = ____alloc_ei_netdev(sizeof(struct etherh_priv));
 659         if (!dev) {
 660                 ret = -ENOMEM;
 661                 goto release;
 662         }
 663
 664         SET_MODULE_OWNER(dev);
 665         SET_NETDEV_DEV(dev, &ec->dev);
 666
 667         dev->open               = etherh_open;
 668         dev->stop               = etherh_close;
 669         dev->set_config         = etherh_set_config;
 670         dev->irq                = ec->irq;
 671         dev->ethtool_ops        = &etherh_ethtool_ops;
 672
 673         if (data->supported & SUPPORTED_Autoneg)
 674                 dev->flags |= IFF_AUTOMEDIA;
 675         if (data->supported & SUPPORTED_TP) {
 676                 dev->flags |= IFF_PORTSEL;
 677                 dev->if_port = IF_PORT_10BASET;
 678         } else if (data->supported & SUPPORTED_BNC) {
 679                 dev->flags |= IFF_PORTSEL;
 680                 dev->if_port = IF_PORT_10BASE2;
 681         } else
 682                 dev->if_port = IF_PORT_UNKNOWN;
 683
 684         eh = etherh_priv(dev);
 685         eh->supported           = data->supported;
 686         eh->ctrl                = 0;
 687         eh->id                  = ec->cid.product;
 688         eh->memc                = ecardm_iomap(ec, ECARD_RES_MEMC, 0, PAGE_SIZE);
 689         if (!eh->memc) {
 690                 ret = -ENOMEM;
 691                 goto free;
 692         }
 693
 694         eh->ctrl_port = eh->memc;
 695         if (data->ctrl_ioc) {
 696                 eh->ioc_fast = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, PAGE_SIZE);
 697                 if (!eh->ioc_fast) {
 698                         ret = -ENOMEM;
 699                         goto free;
 700                 }
 701                 eh->ctrl_port = eh->ioc_fast;
 702         }
 703
 704         dev->base_addr = (unsigned long)eh->memc + data->ns8390_offset;
 705         eh->dma_base = eh->memc + data->dataport_offset;
 706         eh->ctrl_port += data->ctrlport_offset;
 707
 708         /*
 709          * IRQ and control port handling - only for non-NIC slot cards.
 710          */
 711         if (ec->slot_no != 8) {
 712                 ecard_setirq(ec, &etherh_ops, eh);
 713         } else {
 714                 /*
 715                  * If we're in the NIC slot, make sure the IRQ is enabled
 716                  */
 717                 etherh_set_ctrl(eh, ETHERH_CP_IE);
 718         }
 719
 720         ei_local = netdev_priv(dev);
 721         spin_lock_init(&ei_local->page_lock);
 722
 723         if (ec->cid.product == PROD_ANT_ETHERM) {
 724                 etherm_addr(dev->dev_addr);
 725                 ei_local->reg_offset = etherm_regoffsets;
 726         } else {
 727                 etherh_addr(dev->dev_addr, ec);
 728                 ei_local->reg_offset = etherh_regoffsets;
 729         }
 730
 731         ei_local->name          = dev->name;
 732         ei_local->word16        = 1;
 733         ei_local->tx_start_page = data->tx_start_page;
 734         ei_local->rx_start_page = ei_local->tx_start_page + TX_PAGES;
 735         ei_local->stop_page     = data->stop_page;
 736         ei_local->reset_8390    = etherh_reset;
 737         ei_local->block_input   = etherh_block_input;
 738         ei_local->block_output  = etherh_block_output;
 739         ei_local->get_8390_hdr  = etherh_get_header;
 740         ei_local->interface_num = 0;
 741
 742         etherh_reset(dev);
 743         __NS8390_init(dev, 0);
 744
 745         ret = register_netdev(dev);
 746         if (ret)
 747                 goto free;
 748
 749         printk(KERN_INFO "%s: %s in slot %d, ",
 750                 dev->name, data->name, ec->slot_no);
 751
 752         for (i = 0; i < 6; i++)
 753                 printk("%2.2x%c", dev->dev_addr[i], i == 5 ? '\n' : ':');
 754
 755         ecard_set_drvdata(ec, dev);
 756
 757         return 0;
 758
 759  free:
 760         free_netdev(dev);
 761  release:
 762         ecard_release_resources(ec);
 763  out:
 764         return ret;
 765 }
 766
 767 static void __devexit etherh_remove(struct expansion_card *ec)
 768 {
 769         struct net_device *dev = ecard_get_drvdata(ec);
 770
 771         ecard_set_drvdata(ec, NULL);
 772
 773         unregister_netdev(dev);
 774
 775         free_netdev(dev);
 776
 777         ecard_release_resources(ec);
 778 }
 779
 780 static struct etherh_data etherm_data = {
 781         .ns8390_offset          = ETHERM_NS8390,
 782         .dataport_offset        = ETHERM_NS8390 + ETHERM_DATAPORT,
 783         .ctrlport_offset        = ETHERM_NS8390 + ETHERM_CTRLPORT,
 784         .name                   = "ANT EtherM",
 785         .supported              = SUPPORTED_10baseT_Half,
 786         .tx_start_page          = ETHERM_TX_START_PAGE,
 787         .stop_page              = ETHERM_STOP_PAGE,
 788 };
 789
 790 static struct etherh_data etherlan500_data = {
 791         .ns8390_offset          = ETHERH500_NS8390,
 792         .dataport_offset        = ETHERH500_NS8390 + ETHERH500_DATAPORT,
 793         .ctrlport_offset        = ETHERH500_CTRLPORT,
 794         .ctrl_ioc               = 1,
 795         .name                   = "i3 EtherH 500",
 796         .supported              = SUPPORTED_10baseT_Half,
 797         .tx_start_page          = ETHERH_TX_START_PAGE,
 798         .stop_page              = ETHERH_STOP_PAGE,
 799 };
 800
 801 static struct etherh_data etherlan600_data = {
 802         .ns8390_offset          = ETHERH600_NS8390,
 803         .dataport_offset        = ETHERH600_NS8390 + ETHERH600_DATAPORT,
 804         .ctrlport_offset        = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
 805         .name                   = "i3 EtherH 600",
 806         .supported              = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
 807         .tx_start_page          = ETHERH_TX_START_PAGE,
 808         .stop_page              = ETHERH_STOP_PAGE,
 809 };
 810
 811 static struct etherh_data etherlan600a_data = {
 812         .ns8390_offset          = ETHERH600_NS8390,
 813         .dataport_offset        = ETHERH600_NS8390 + ETHERH600_DATAPORT,
 814         .ctrlport_offset        = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
 815         .name                   = "i3 EtherH 600A",
 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
 821 static const struct ecard_id etherh_ids[] = {
 822         { MANU_ANT, PROD_ANT_ETHERM,      &etherm_data       },
 823         { MANU_I3,  PROD_I3_ETHERLAN500,  &etherlan500_data  },
 824         { MANU_I3,  PROD_I3_ETHERLAN600,  &etherlan600_data  },
 825         { MANU_I3,  PROD_I3_ETHERLAN600A, &etherlan600a_data },
 826         { 0xffff,   0xffff }
 827 };
 828
 829 static struct ecard_driver etherh_driver = {
 830         .probe          = etherh_probe,
 831         .remove         = __devexit_p(etherh_remove),
 832         .id_table       = etherh_ids,
 833         .drv = {
 834                 .name   = DRV_NAME,
 835         },
 836 };
 837
 838 static int __init etherh_init(void)
 839 {
 840         int i;
 841
 842         for (i = 0; i < 16; i++) {
 843                 etherh_regoffsets[i] = i << 2;
 844                 etherm_regoffsets[i] = i << 5;
 845         }
 846
 847         return ecard_register_driver(&etherh_driver);
 848 }
 849
 850 static void __exit etherh_exit(void)
 851 {
 852         ecard_remove_driver(&etherh_driver);
 853 }
 854
 855 module_init(etherh_init);
 856 module_exit(etherh_exit);