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