drivers/staging/slicoss/slicoss.c

   1 /**************************************************************************
   2  *
   3  * Copyright  2000-2006 Alacritech, Inc.  All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  *
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above
  12  *    copyright notice, this list of conditions and the following
  13  *    disclaimer in the documentation and/or other materials provided
  14  *    with the distribution.
  15  *
  16  * Alternatively, this software may be distributed under the terms of the
  17  * GNU General Public License ("GPL") version 2 as published by the Free
  18  * Software Foundation.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY ALACRITECH, INC. ``AS IS'' AND ANY
  21  * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  23  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ALACRITECH, INC. OR
  24  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  25  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  26  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
  27  * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  28  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  29  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
  30  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  31  * SUCH DAMAGE.
  32  *
  33  * The views and conclusions contained in the software and documentation
  34  * are those of the authors and should not be interpreted as representing
  35  * official policies, either expressed or implied, of Alacritech, Inc.
  36  *
  37  **************************************************************************/
  38
  39 /*
  40  * FILENAME: slicoss.c
  41  *
  42  * The SLICOSS driver for Alacritech's IS-NIC products.
  43  *
  44  * This driver is supposed to support:
  45  *
  46  *      Mojave cards (single port PCI Gigabit) both copper and fiber
  47  *      Oasis cards (single and dual port PCI-x Gigabit) copper and fiber
  48  *      Kalahari cards (dual and quad port PCI-e Gigabit) copper and fiber
  49  *
  50  * The driver was actually tested on Oasis and Kalahari cards.
  51  *
  52  *
  53  * NOTE: This is the standard, non-accelerated version of Alacritech's
  54  *       IS-NIC driver.
  55  */
  56
  57 #define KLUDGE_FOR_4GB_BOUNDARY         1
  58 #define DEBUG_MICROCODE                 1
  59 #define DBG                             1
  60 #define SLIC_INTERRUPT_PROCESS_LIMIT    1
  61 #define SLIC_OFFLOAD_IP_CHECKSUM        1
  62 #define STATS_TIMER_INTERVAL            2
  63 #define PING_TIMER_INTERVAL             1
  64 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  65
  66 #include <linux/kernel.h>
  67 #include <linux/string.h>
  68 #include <linux/errno.h>
  69 #include <linux/ioport.h>
  70 #include <linux/slab.h>
  71 #include <linux/interrupt.h>
  72 #include <linux/timer.h>
  73 #include <linux/pci.h>
  74 #include <linux/spinlock.h>
  75 #include <linux/init.h>
  76 #include <linux/bitops.h>
  77 #include <linux/io.h>
  78 #include <linux/netdevice.h>
  79 #include <linux/crc32.h>
  80 #include <linux/etherdevice.h>
  81 #include <linux/skbuff.h>
  82 #include <linux/delay.h>
  83 #include <linux/seq_file.h>
  84 #include <linux/kthread.h>
  85 #include <linux/module.h>
  86
  87 #include <linux/firmware.h>
  88 #include <linux/types.h>
  89 #include <linux/dma-mapping.h>
  90 #include <linux/mii.h>
  91 #include <linux/if_vlan.h>
  92 #include <asm/unaligned.h>
  93
  94 #include <linux/ethtool.h>
  95 #include <linux/uaccess.h>
  96 #include "slichw.h"
  97 #include "slic.h"
  98
  99 static uint slic_first_init = 1;
 100 static char *slic_banner = "Alacritech SLIC Technology(tm) Server and Storage Accelerator (Non-Accelerated)";
 101
 102 static char *slic_proc_version = "2.0.351  2006/07/14 12:26:00";
 103
 104 static struct base_driver slic_global = { {}, 0, 0, 0, 1, NULL, NULL };
 105 #define DEFAULT_INTAGG_DELAY 100
 106 static unsigned int rcv_count;
 107
 108 #define DRV_NAME          "slicoss"
 109 #define DRV_VERSION       "2.0.1"
 110 #define DRV_AUTHOR        "Alacritech, Inc. Engineering"
 111 #define DRV_DESCRIPTION   "Alacritech SLIC Techonology(tm) "\
 112                 "Non-Accelerated Driver"
 113 #define DRV_COPYRIGHT     "Copyright  2000-2006 Alacritech, Inc. "\
 114                 "All rights reserved."
 115 #define PFX                DRV_NAME " "
 116
 117 MODULE_AUTHOR(DRV_AUTHOR);
 118 MODULE_DESCRIPTION(DRV_DESCRIPTION);
 119 MODULE_LICENSE("Dual BSD/GPL");
 120
 121 static const struct pci_device_id slic_pci_tbl[] = {
 122         { PCI_DEVICE(PCI_VENDOR_ID_ALACRITECH, SLIC_1GB_DEVICE_ID) },
 123         { PCI_DEVICE(PCI_VENDOR_ID_ALACRITECH, SLIC_2GB_DEVICE_ID) },
 124         { 0 }
 125 };
 126
 127 static struct ethtool_ops slic_ethtool_ops;
 128
 129 MODULE_DEVICE_TABLE(pci, slic_pci_tbl);
 130
 131 static inline void slic_reg32_write(void __iomem *reg, u32 value, bool flush)
 132 {
 133         writel(value, reg);
 134         if (flush)
 135                 mb();
 136 }
 137
 138 static inline void slic_reg64_write(struct adapter *adapter, void __iomem *reg,
 139                                     u32 value, void __iomem *regh, u32 paddrh,
 140                                     bool flush)
 141 {
 142         unsigned long flags;
 143
 144         spin_lock_irqsave(&adapter->bit64reglock, flags);
 145         writel(paddrh, regh);
 146         writel(value, reg);
 147         if (flush)
 148                 mb();
 149         spin_unlock_irqrestore(&adapter->bit64reglock, flags);
 150 }
 151
 152 static void slic_mcast_set_bit(struct adapter *adapter, char *address)
 153 {
 154         unsigned char crcpoly;
 155
 156         /* Get the CRC polynomial for the mac address */
 157         /*
 158          * we use bits 1-8 (lsb), bitwise reversed,
 159          * msb (= lsb bit 0 before bitrev) is automatically discarded
 160          */
 161         crcpoly = ether_crc(ETH_ALEN, address) >> 23;
 162
 163         /*
 164          * We only have space on the SLIC for 64 entries.  Lop
 165          * off the top two bits. (2^6 = 64)
 166          */
 167         crcpoly &= 0x3F;
 168
 169         /* OR in the new bit into our 64 bit mask. */
 170         adapter->mcastmask |= (u64)1 << crcpoly;
 171 }
 172
 173 static void slic_mcast_set_mask(struct adapter *adapter)
 174 {
 175         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 176
 177         if (adapter->macopts & (MAC_ALLMCAST | MAC_PROMISC)) {
 178                 /*
 179                  * Turn on all multicast addresses. We have to do this for
 180                  * promiscuous mode as well as ALLMCAST mode.  It saves the
 181                  * Microcode from having to keep state about the MAC
 182                  * configuration.
 183                  */
 184                 slic_reg32_write(&slic_regs->slic_mcastlow, 0xFFFFFFFF, FLUSH);
 185                 slic_reg32_write(&slic_regs->slic_mcasthigh, 0xFFFFFFFF,
 186                                  FLUSH);
 187         } else {
 188                 /*
 189                  * Commit our multicast mast to the SLIC by writing to the
 190                  * multicast address mask registers
 191                  */
 192                 slic_reg32_write(&slic_regs->slic_mcastlow,
 193                         (u32)(adapter->mcastmask & 0xFFFFFFFF), FLUSH);
 194                 slic_reg32_write(&slic_regs->slic_mcasthigh,
 195                         (u32)((adapter->mcastmask >> 32) & 0xFFFFFFFF), FLUSH);
 196         }
 197 }
 198
 199 static void slic_timer_ping(ulong dev)
 200 {
 201         struct adapter *adapter;
 202         struct sliccard *card;
 203
 204         adapter = netdev_priv((struct net_device *)dev);
 205         card = adapter->card;
 206
 207         adapter->pingtimer.expires = jiffies + (PING_TIMER_INTERVAL * HZ);
 208         add_timer(&adapter->pingtimer);
 209 }
 210
 211 static void slic_unmap_mmio_space(struct adapter *adapter)
 212 {
 213         if (adapter->slic_regs)
 214                 iounmap(adapter->slic_regs);
 215         adapter->slic_regs = NULL;
 216 }
 217
 218 /*
 219  *  slic_link_config
 220  *
 221  *  Write phy control to configure link duplex/speed
 222  *
 223  */
 224 static void slic_link_config(struct adapter *adapter,
 225                       u32 linkspeed, u32 linkduplex)
 226 {
 227         u32 __iomem *wphy;
 228         u32 speed;
 229         u32 duplex;
 230         u32 phy_config;
 231         u32 phy_advreg;
 232         u32 phy_gctlreg;
 233
 234         if (adapter->state != ADAPT_UP)
 235                 return;
 236
 237         if (linkspeed > LINK_1000MB)
 238                 linkspeed = LINK_AUTOSPEED;
 239         if (linkduplex > LINK_AUTOD)
 240                 linkduplex = LINK_AUTOD;
 241
 242         wphy = &adapter->slic_regs->slic_wphy;
 243
 244         if ((linkspeed == LINK_AUTOSPEED) || (linkspeed == LINK_1000MB)) {
 245                 if (adapter->flags & ADAPT_FLAGS_FIBERMEDIA) {
 246                         /*
 247                          * We've got a fiber gigabit interface, and register
 248                          *  4 is different in fiber mode than in copper mode
 249                          */
 250
 251                         /* advertise FD only @1000 Mb */
 252                         phy_advreg = (MIICR_REG_4 | (PAR_ADV1000XFD));
 253                         /* enable PAUSE frames        */
 254                         phy_advreg |= PAR_ASYMPAUSE_FIBER;
 255                         slic_reg32_write(wphy, phy_advreg, FLUSH);
 256
 257                         if (linkspeed == LINK_AUTOSPEED) {
 258                                 /* reset phy, enable auto-neg  */
 259                                 phy_config =
 260                                     (MIICR_REG_PCR |
 261                                      (PCR_RESET | PCR_AUTONEG |
 262                                       PCR_AUTONEG_RST));
 263                                 slic_reg32_write(wphy, phy_config, FLUSH);
 264                         } else {        /* forced 1000 Mb FD*/
 265                                 /*
 266                                  * power down phy to break link
 267                                  * this may not work)
 268                                  */
 269                                 phy_config = (MIICR_REG_PCR | PCR_POWERDOWN);
 270                                 slic_reg32_write(wphy, phy_config, FLUSH);
 271                                 /*
 272                                  * wait, Marvell says 1 sec,
 273                                  * try to get away with 10 ms
 274                                  */
 275                                 mdelay(10);
 276
 277                                 /*
 278                                  * disable auto-neg, set speed/duplex,
 279                                  * soft reset phy, powerup
 280                                  */
 281                                 phy_config =
 282                                     (MIICR_REG_PCR |
 283                                      (PCR_RESET | PCR_SPEED_1000 |
 284                                       PCR_DUPLEX_FULL));
 285                                 slic_reg32_write(wphy, phy_config, FLUSH);
 286                         }
 287                 } else {        /* copper gigabit */
 288
 289                         /*
 290                          * Auto-Negotiate or 1000 Mb must be auto negotiated
 291                          * We've got a copper gigabit interface, and
 292                          * register 4 is different in copper mode than
 293                          * in fiber mode
 294                          */
 295                         if (linkspeed == LINK_AUTOSPEED) {
 296                                 /* advertise 10/100 Mb modes   */
 297                                 phy_advreg =
 298                                     (MIICR_REG_4 |
 299                                      (PAR_ADV100FD | PAR_ADV100HD | PAR_ADV10FD
 300                                       | PAR_ADV10HD));
 301                         } else {
 302                         /*
 303                          * linkspeed == LINK_1000MB -
 304                          * don't advertise 10/100 Mb modes
 305                          */
 306                                 phy_advreg = MIICR_REG_4;
 307                         }
 308                         /* enable PAUSE frames  */
 309                         phy_advreg |= PAR_ASYMPAUSE;
 310                         /* required by the Cicada PHY  */
 311                         phy_advreg |= PAR_802_3;
 312                         slic_reg32_write(wphy, phy_advreg, FLUSH);
 313                         /* advertise FD only @1000 Mb  */
 314                         phy_gctlreg = (MIICR_REG_9 | (PGC_ADV1000FD));
 315                         slic_reg32_write(wphy, phy_gctlreg, FLUSH);
 316
 317                         if (adapter->subsysid != SLIC_1GB_CICADA_SUBSYS_ID) {
 318                                 /*
 319                                  * if a Marvell PHY
 320                                  * enable auto crossover
 321                                  */
 322                                 phy_config =
 323                                     (MIICR_REG_16 | (MRV_REG16_XOVERON));
 324                                 slic_reg32_write(wphy, phy_config, FLUSH);
 325
 326                                 /* reset phy, enable auto-neg  */
 327                                 phy_config =
 328                                     (MIICR_REG_PCR |
 329                                      (PCR_RESET | PCR_AUTONEG |
 330                                       PCR_AUTONEG_RST));
 331                                 slic_reg32_write(wphy, phy_config, FLUSH);
 332                         } else {        /* it's a Cicada PHY  */
 333                                 /* enable and restart auto-neg (don't reset)  */
 334                                 phy_config =
 335                                     (MIICR_REG_PCR |
 336                                      (PCR_AUTONEG | PCR_AUTONEG_RST));
 337                                 slic_reg32_write(wphy, phy_config, FLUSH);
 338                         }
 339                 }
 340         } else {
 341                 /* Forced 10/100  */
 342                 if (linkspeed == LINK_10MB)
 343                         speed = 0;
 344                 else
 345                         speed = PCR_SPEED_100;
 346                 if (linkduplex == LINK_HALFD)
 347                         duplex = 0;
 348                 else
 349                         duplex = PCR_DUPLEX_FULL;
 350
 351                 if (adapter->subsysid != SLIC_1GB_CICADA_SUBSYS_ID) {
 352                         /*
 353                          * if a Marvell PHY
 354                          * disable auto crossover
 355                          */
 356                         phy_config = (MIICR_REG_16 | (MRV_REG16_XOVEROFF));
 357                         slic_reg32_write(wphy, phy_config, FLUSH);
 358                 }
 359
 360                 /* power down phy to break link (this may not work)  */
 361                 phy_config = (MIICR_REG_PCR | (PCR_POWERDOWN | speed | duplex));
 362                 slic_reg32_write(wphy, phy_config, FLUSH);
 363
 364                 /* wait, Marvell says 1 sec, try to get away with 10 ms */
 365                 mdelay(10);
 366
 367                 if (adapter->subsysid != SLIC_1GB_CICADA_SUBSYS_ID) {
 368                         /*
 369                          * if a Marvell PHY
 370                          * disable auto-neg, set speed,
 371                          * soft reset phy, powerup
 372                          */
 373                         phy_config =
 374                             (MIICR_REG_PCR | (PCR_RESET | speed | duplex));
 375                         slic_reg32_write(wphy, phy_config, FLUSH);
 376                 } else {        /* it's a Cicada PHY  */
 377                         /* disable auto-neg, set speed, powerup  */
 378                         phy_config = (MIICR_REG_PCR | (speed | duplex));
 379                         slic_reg32_write(wphy, phy_config, FLUSH);
 380                 }
 381         }
 382 }
 383
 384 static int slic_card_download_gbrcv(struct adapter *adapter)
 385 {
 386         const struct firmware *fw;
 387         const char *file = "";
 388         int ret;
 389         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 390         u32 codeaddr;
 391         u32 instruction;
 392         int index = 0;
 393         u32 rcvucodelen = 0;
 394
 395         switch (adapter->devid) {
 396         case SLIC_2GB_DEVICE_ID:
 397                 file = "slicoss/oasisrcvucode.sys";
 398                 break;
 399         case SLIC_1GB_DEVICE_ID:
 400                 file = "slicoss/gbrcvucode.sys";
 401                 break;
 402         default:
 403                 return -ENOENT;
 404         }
 405
 406         ret = request_firmware(&fw, file, &adapter->pcidev->dev);
 407         if (ret) {
 408                 dev_err(&adapter->pcidev->dev,
 409                         "Failed to load firmware %s\n", file);
 410                 return ret;
 411         }
 412
 413         rcvucodelen = *(u32 *)(fw->data + index);
 414         index += 4;
 415         switch (adapter->devid) {
 416         case SLIC_2GB_DEVICE_ID:
 417                 if (rcvucodelen != OasisRcvUCodeLen) {
 418                         release_firmware(fw);
 419                         return -EINVAL;
 420                 }
 421                 break;
 422         case SLIC_1GB_DEVICE_ID:
 423                 if (rcvucodelen != GBRcvUCodeLen) {
 424                         release_firmware(fw);
 425                         return -EINVAL;
 426                 }
 427                 break;
 428         }
 429         /* start download */
 430         slic_reg32_write(&slic_regs->slic_rcv_wcs, SLIC_RCVWCS_BEGIN, FLUSH);
 431         /* download the rcv sequencer ucode */
 432         for (codeaddr = 0; codeaddr < rcvucodelen; codeaddr++) {
 433                 /* write out instruction address */
 434                 slic_reg32_write(&slic_regs->slic_rcv_wcs, codeaddr, FLUSH);
 435
 436                 instruction = *(u32 *)(fw->data + index);
 437                 index += 4;
 438                 /* write out the instruction data low addr */
 439                 slic_reg32_write(&slic_regs->slic_rcv_wcs, instruction, FLUSH);
 440
 441                 instruction = *(u8 *)(fw->data + index);
 442                 index++;
 443                 /* write out the instruction data high addr */
 444                 slic_reg32_write(&slic_regs->slic_rcv_wcs, (u8)instruction,
 445                                  FLUSH);
 446         }
 447
 448         /* download finished */
 449         release_firmware(fw);
 450         slic_reg32_write(&slic_regs->slic_rcv_wcs, SLIC_RCVWCS_FINISH, FLUSH);
 451         return 0;
 452 }
 453
 454 MODULE_FIRMWARE("slicoss/oasisrcvucode.sys");
 455 MODULE_FIRMWARE("slicoss/gbrcvucode.sys");
 456
 457 static int slic_card_download(struct adapter *adapter)
 458 {
 459         const struct firmware *fw;
 460         const char *file = "";
 461         int ret;
 462         u32 section;
 463         int thissectionsize;
 464         int codeaddr;
 465         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 466         u32 instruction;
 467         u32 baseaddress;
 468         u32 i;
 469         u32 numsects = 0;
 470         u32 sectsize[3];
 471         u32 sectstart[3];
 472         int ucode_start, index = 0;
 473
 474         switch (adapter->devid) {
 475         case SLIC_2GB_DEVICE_ID:
 476                 file = "slicoss/oasisdownload.sys";
 477                 break;
 478         case SLIC_1GB_DEVICE_ID:
 479                 file = "slicoss/gbdownload.sys";
 480                 break;
 481         default:
 482                 return -ENOENT;
 483         }
 484         ret = request_firmware(&fw, file, &adapter->pcidev->dev);
 485         if (ret) {
 486                 dev_err(&adapter->pcidev->dev,
 487                         "Failed to load firmware %s\n", file);
 488                 return ret;
 489         }
 490         numsects = *(u32 *)(fw->data + index);
 491         index += 4;
 492         for (i = 0; i < numsects; i++) {
 493                 sectsize[i] = *(u32 *)(fw->data + index);
 494                 index += 4;
 495         }
 496         for (i = 0; i < numsects; i++) {
 497                 sectstart[i] = *(u32 *)(fw->data + index);
 498                 index += 4;
 499         }
 500         ucode_start = index;
 501         instruction = *(u32 *)(fw->data + index);
 502         index += 4;
 503         for (section = 0; section < numsects; section++) {
 504                 baseaddress = sectstart[section];
 505                 thissectionsize = sectsize[section] >> 3;
 506
 507                 for (codeaddr = 0; codeaddr < thissectionsize; codeaddr++) {
 508                         /* Write out instruction address */
 509                         slic_reg32_write(&slic_regs->slic_wcs,
 510                                          baseaddress + codeaddr, FLUSH);
 511                         /* Write out instruction to low addr */
 512                         slic_reg32_write(&slic_regs->slic_wcs,
 513                                         instruction, FLUSH);
 514                         instruction = *(u32 *)(fw->data + index);
 515                         index += 4;
 516
 517                         /* Write out instruction to high addr */
 518                         slic_reg32_write(&slic_regs->slic_wcs,
 519                                         instruction, FLUSH);
 520                         instruction = *(u32 *)(fw->data + index);
 521                         index += 4;
 522                 }
 523         }
 524         index = ucode_start;
 525         for (section = 0; section < numsects; section++) {
 526                 instruction = *(u32 *)(fw->data + index);
 527                 baseaddress = sectstart[section];
 528                 if (baseaddress < 0x8000)
 529                         continue;
 530                 thissectionsize = sectsize[section] >> 3;
 531
 532                 for (codeaddr = 0; codeaddr < thissectionsize; codeaddr++) {
 533                         /* Write out instruction address */
 534                         slic_reg32_write(&slic_regs->slic_wcs,
 535                                 SLIC_WCS_COMPARE | (baseaddress + codeaddr),
 536                                 FLUSH);
 537                         /* Write out instruction to low addr */
 538                         slic_reg32_write(&slic_regs->slic_wcs, instruction,
 539                                          FLUSH);
 540                         instruction = *(u32 *)(fw->data + index);
 541                         index += 4;
 542                         /* Write out instruction to high addr */
 543                         slic_reg32_write(&slic_regs->slic_wcs, instruction,
 544                                          FLUSH);
 545                         instruction = *(u32 *)(fw->data + index);
 546                         index += 4;
 547
 548                         /* Check SRAM location zero. If it is non-zero. Abort.*/
 549                      /*
 550                       * failure = readl((u32 __iomem *)&slic_regs->slic_reset);
 551                       * if (failure) {
 552                       * release_firmware(fw);
 553                       * return -EIO;
 554                       * }
 555                       */
 556                 }
 557         }
 558         release_firmware(fw);
 559         /* Everything OK, kick off the card */
 560         mdelay(10);
 561         slic_reg32_write(&slic_regs->slic_wcs, SLIC_WCS_START, FLUSH);
 562
 563         /*
 564          * stall for 20 ms, long enough for ucode to init card
 565          * and reach mainloop
 566          */
 567         mdelay(20);
 568
 569         return 0;
 570 }
 571
 572 MODULE_FIRMWARE("slicoss/oasisdownload.sys");
 573 MODULE_FIRMWARE("slicoss/gbdownload.sys");
 574
 575 static void slic_adapter_set_hwaddr(struct adapter *adapter)
 576 {
 577         struct sliccard *card = adapter->card;
 578
 579         if ((adapter->card) && (card->config_set)) {
 580                 memcpy(adapter->macaddr,
 581                        card->config.MacInfo[adapter->functionnumber].macaddrA,
 582                        sizeof(struct slic_config_mac));
 583                 if (is_zero_ether_addr(adapter->currmacaddr))
 584                         memcpy(adapter->currmacaddr, adapter->macaddr,
 585                                ETH_ALEN);
 586                 if (adapter->netdev)
 587                         memcpy(adapter->netdev->dev_addr, adapter->currmacaddr,
 588                                ETH_ALEN);
 589         }
 590 }
 591
 592 static void slic_intagg_set(struct adapter *adapter, u32 value)
 593 {
 594         slic_reg32_write(&adapter->slic_regs->slic_intagg, value, FLUSH);
 595         adapter->card->loadlevel_current = value;
 596 }
 597
 598 static void slic_soft_reset(struct adapter *adapter)
 599 {
 600         if (adapter->card->state == CARD_UP) {
 601                 slic_reg32_write(&adapter->slic_regs->slic_quiesce, 0, FLUSH);
 602                 mdelay(1);
 603         }
 604
 605         slic_reg32_write(&adapter->slic_regs->slic_reset, SLIC_RESET_MAGIC,
 606                          FLUSH);
 607         mdelay(1);
 608 }
 609
 610 static void slic_mac_address_config(struct adapter *adapter)
 611 {
 612         u32 value;
 613         u32 value2;
 614         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 615
 616         value = ntohl(*(__be32 *)&adapter->currmacaddr[2]);
 617         slic_reg32_write(&slic_regs->slic_wraddral, value, FLUSH);
 618         slic_reg32_write(&slic_regs->slic_wraddrbl, value, FLUSH);
 619
 620         value2 = (u32)((adapter->currmacaddr[0] << 8 |
 621                              adapter->currmacaddr[1]) & 0xFFFF);
 622
 623         slic_reg32_write(&slic_regs->slic_wraddrah, value2, FLUSH);
 624         slic_reg32_write(&slic_regs->slic_wraddrbh, value2, FLUSH);
 625
 626         /*
 627          * Write our multicast mask out to the card.  This is done
 628          * here in addition to the slic_mcast_addr_set routine
 629          * because ALL_MCAST may have been enabled or disabled
 630          */
 631         slic_mcast_set_mask(adapter);
 632 }
 633
 634 static void slic_mac_config(struct adapter *adapter)
 635 {
 636         u32 value;
 637         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 638
 639         /* Setup GMAC gaps */
 640         if (adapter->linkspeed == LINK_1000MB) {
 641                 value = ((GMCR_GAPBB_1000 << GMCR_GAPBB_SHIFT) |
 642                          (GMCR_GAPR1_1000 << GMCR_GAPR1_SHIFT) |
 643                          (GMCR_GAPR2_1000 << GMCR_GAPR2_SHIFT));
 644         } else {
 645                 value = ((GMCR_GAPBB_100 << GMCR_GAPBB_SHIFT) |
 646                          (GMCR_GAPR1_100 << GMCR_GAPR1_SHIFT) |
 647                          (GMCR_GAPR2_100 << GMCR_GAPR2_SHIFT));
 648         }
 649
 650         /* enable GMII */
 651         if (adapter->linkspeed == LINK_1000MB)
 652                 value |= GMCR_GBIT;
 653
 654         /* enable fullduplex */
 655         if ((adapter->linkduplex == LINK_FULLD)
 656             || (adapter->macopts & MAC_LOOPBACK)) {
 657                 value |= GMCR_FULLD;
 658         }
 659
 660         /* write mac config */
 661         slic_reg32_write(&slic_regs->slic_wmcfg, value, FLUSH);
 662
 663         /* setup mac addresses */
 664         slic_mac_address_config(adapter);
 665 }
 666
 667 static void slic_config_set(struct adapter *adapter, bool linkchange)
 668 {
 669         u32 value;
 670         u32 RcrReset;
 671         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 672
 673         if (linkchange) {
 674                 /* Setup MAC */
 675                 slic_mac_config(adapter);
 676                 RcrReset = GRCR_RESET;
 677         } else {
 678                 slic_mac_address_config(adapter);
 679                 RcrReset = 0;
 680         }
 681
 682         if (adapter->linkduplex == LINK_FULLD) {
 683                 /* setup xmtcfg */
 684                 value = (GXCR_RESET |   /* Always reset     */
 685                          GXCR_XMTEN |   /* Enable transmit  */
 686                          GXCR_PAUSEEN); /* Enable pause     */
 687
 688                 slic_reg32_write(&slic_regs->slic_wxcfg, value, FLUSH);
 689
 690                 /* Setup rcvcfg last */
 691                 value = (RcrReset |     /* Reset, if linkchange */
 692                          GRCR_CTLEN |   /* Enable CTL frames    */
 693                          GRCR_ADDRAEN | /* Address A enable     */
 694                          GRCR_RCVBAD |  /* Rcv bad frames       */
 695                          (GRCR_HASHSIZE << GRCR_HASHSIZE_SHIFT));
 696         } else {
 697                 /* setup xmtcfg */
 698                 value = (GXCR_RESET |   /* Always reset     */
 699                          GXCR_XMTEN);   /* Enable transmit  */
 700
 701                 slic_reg32_write(&slic_regs->slic_wxcfg, value, FLUSH);
 702
 703                 /* Setup rcvcfg last */
 704                 value = (RcrReset |     /* Reset, if linkchange */
 705                          GRCR_ADDRAEN | /* Address A enable     */
 706                          GRCR_RCVBAD |  /* Rcv bad frames       */
 707                          (GRCR_HASHSIZE << GRCR_HASHSIZE_SHIFT));
 708         }
 709
 710         if (adapter->state != ADAPT_DOWN) {
 711                 /* Only enable receive if we are restarting or running */
 712                 value |= GRCR_RCVEN;
 713         }
 714
 715         if (adapter->macopts & MAC_PROMISC)
 716                 value |= GRCR_RCVALL;
 717
 718         slic_reg32_write(&slic_regs->slic_wrcfg, value, FLUSH);
 719 }
 720
 721 /*
 722  *  Turn off RCV and XMT, power down PHY
 723  */
 724 static void slic_config_clear(struct adapter *adapter)
 725 {
 726         u32 value;
 727         u32 phy_config;
 728         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 729
 730         /* Setup xmtcfg */
 731         value = (GXCR_RESET |   /* Always reset */
 732                  GXCR_PAUSEEN); /* Enable pause */
 733
 734         slic_reg32_write(&slic_regs->slic_wxcfg, value, FLUSH);
 735
 736         value = (GRCR_RESET |   /* Always reset      */
 737                  GRCR_CTLEN |   /* Enable CTL frames */
 738                  GRCR_ADDRAEN | /* Address A enable  */
 739                  (GRCR_HASHSIZE << GRCR_HASHSIZE_SHIFT));
 740
 741         slic_reg32_write(&slic_regs->slic_wrcfg, value, FLUSH);
 742
 743         /* power down phy */
 744         phy_config = (MIICR_REG_PCR | (PCR_POWERDOWN));
 745         slic_reg32_write(&slic_regs->slic_wphy, phy_config, FLUSH);
 746 }
 747
 748 static bool slic_mac_filter(struct adapter *adapter,
 749                         struct ether_header *ether_frame)
 750 {
 751         struct net_device *netdev = adapter->netdev;
 752         u32 opts = adapter->macopts;
 753
 754         if (opts & MAC_PROMISC)
 755                 return true;
 756
 757         if (is_broadcast_ether_addr(ether_frame->ether_dhost)) {
 758                 if (opts & MAC_BCAST) {
 759                         adapter->rcv_broadcasts++;
 760                         return true;
 761                 }
 762
 763                 return false;
 764         }
 765
 766         if (is_multicast_ether_addr(ether_frame->ether_dhost)) {
 767                 if (opts & MAC_ALLMCAST) {
 768                         adapter->rcv_multicasts++;
 769                         netdev->stats.multicast++;
 770                         return true;
 771                 }
 772                 if (opts & MAC_MCAST) {
 773                         struct mcast_address *mcaddr = adapter->mcastaddrs;
 774
 775                         while (mcaddr) {
 776                                 if (ether_addr_equal(mcaddr->address,
 777                                                      ether_frame->ether_dhost)) {
 778                                         adapter->rcv_multicasts++;
 779                                         netdev->stats.multicast++;
 780                                         return true;
 781                                 }
 782                                 mcaddr = mcaddr->next;
 783                         }
 784
 785                         return false;
 786                 }
 787
 788                 return false;
 789         }
 790         if (opts & MAC_DIRECTED) {
 791                 adapter->rcv_unicasts++;
 792                 return true;
 793         }
 794         return false;
 795
 796 }
 797
 798 static int slic_mac_set_address(struct net_device *dev, void *ptr)
 799 {
 800         struct adapter *adapter = netdev_priv(dev);
 801         struct sockaddr *addr = ptr;
 802
 803         if (netif_running(dev))
 804                 return -EBUSY;
 805         if (!adapter)
 806                 return -EBUSY;
 807
 808         if (!is_valid_ether_addr(addr->sa_data))
 809                 return -EINVAL;
 810
 811         memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
 812         memcpy(adapter->currmacaddr, addr->sa_data, dev->addr_len);
 813
 814         slic_config_set(adapter, true);
 815         return 0;
 816 }
 817
 818 static void slic_timer_load_check(ulong cardaddr)
 819 {
 820         struct sliccard *card = (struct sliccard *)cardaddr;
 821         struct adapter *adapter = card->master;
 822         u32 __iomem *intagg;
 823         u32 load = card->events;
 824         u32 level = 0;
 825
 826         if ((adapter) && (adapter->state == ADAPT_UP) &&
 827             (card->state == CARD_UP) && (slic_global.dynamic_intagg)) {
 828                 intagg = &adapter->slic_regs->slic_intagg;
 829                 if (adapter->devid == SLIC_1GB_DEVICE_ID) {
 830                         if (adapter->linkspeed == LINK_1000MB)
 831                                 level = 100;
 832                         else {
 833                                 if (load > SLIC_LOAD_5)
 834                                         level = SLIC_INTAGG_5;
 835                                 else if (load > SLIC_LOAD_4)
 836                                         level = SLIC_INTAGG_4;
 837                                 else if (load > SLIC_LOAD_3)
 838                                         level = SLIC_INTAGG_3;
 839                                 else if (load > SLIC_LOAD_2)
 840                                         level = SLIC_INTAGG_2;
 841                                 else if (load > SLIC_LOAD_1)
 842                                         level = SLIC_INTAGG_1;
 843                                 else
 844                                         level = SLIC_INTAGG_0;
 845                         }
 846                         if (card->loadlevel_current != level) {
 847                                 card->loadlevel_current = level;
 848                                 slic_reg32_write(intagg, level, FLUSH);
 849                         }
 850                 } else {
 851                         if (load > SLIC_LOAD_5)
 852                                 level = SLIC_INTAGG_5;
 853                         else if (load > SLIC_LOAD_4)
 854                                 level = SLIC_INTAGG_4;
 855                         else if (load > SLIC_LOAD_3)
 856                                 level = SLIC_INTAGG_3;
 857                         else if (load > SLIC_LOAD_2)
 858                                 level = SLIC_INTAGG_2;
 859                         else if (load > SLIC_LOAD_1)
 860                                 level = SLIC_INTAGG_1;
 861                         else
 862                                 level = SLIC_INTAGG_0;
 863                         if (card->loadlevel_current != level) {
 864                                 card->loadlevel_current = level;
 865                                 slic_reg32_write(intagg, level, FLUSH);
 866                         }
 867                 }
 868         }
 869         card->events = 0;
 870         card->loadtimer.expires = jiffies + (SLIC_LOADTIMER_PERIOD * HZ);
 871         add_timer(&card->loadtimer);
 872 }
 873
 874 static int slic_upr_queue_request(struct adapter *adapter,
 875                            u32 upr_request,
 876                            u32 upr_data,
 877                            u32 upr_data_h,
 878                            u32 upr_buffer, u32 upr_buffer_h)
 879 {
 880         struct slic_upr *upr;
 881         struct slic_upr *uprqueue;
 882
 883         upr = kmalloc(sizeof(struct slic_upr), GFP_ATOMIC);
 884         if (!upr)
 885                 return -ENOMEM;
 886
 887         upr->adapter = adapter->port;
 888         upr->upr_request = upr_request;
 889         upr->upr_data = upr_data;
 890         upr->upr_buffer = upr_buffer;
 891         upr->upr_data_h = upr_data_h;
 892         upr->upr_buffer_h = upr_buffer_h;
 893         upr->next = NULL;
 894         if (adapter->upr_list) {
 895                 uprqueue = adapter->upr_list;
 896
 897                 while (uprqueue->next)
 898                         uprqueue = uprqueue->next;
 899                 uprqueue->next = upr;
 900         } else {
 901                 adapter->upr_list = upr;
 902         }
 903         return 0;
 904 }
 905
 906 static void slic_upr_start(struct adapter *adapter)
 907 {
 908         struct slic_upr *upr;
 909         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
 910 /*
 911  *  char * ptr1;
 912  *  char * ptr2;
 913  *  uint cmdoffset;
 914  */
 915         upr = adapter->upr_list;
 916         if (!upr)
 917                 return;
 918         if (adapter->upr_busy)
 919                 return;
 920         adapter->upr_busy = 1;
 921
 922         switch (upr->upr_request) {
 923         case SLIC_UPR_STATS:
 924                 if (upr->upr_data_h == 0) {
 925                         slic_reg32_write(&slic_regs->slic_stats, upr->upr_data,
 926                                          FLUSH);
 927                 } else {
 928                         slic_reg64_write(adapter, &slic_regs->slic_stats64,
 929                                          upr->upr_data,
 930                                          &slic_regs->slic_addr_upper,
 931                                          upr->upr_data_h, FLUSH);
 932                 }
 933                 break;
 934
 935         case SLIC_UPR_RLSR:
 936                 slic_reg64_write(adapter, &slic_regs->slic_rlsr, upr->upr_data,
 937                                  &slic_regs->slic_addr_upper, upr->upr_data_h,
 938                                  FLUSH);
 939                 break;
 940
 941         case SLIC_UPR_RCONFIG:
 942                 slic_reg64_write(adapter, &slic_regs->slic_rconfig,
 943                                  upr->upr_data, &slic_regs->slic_addr_upper,
 944                                  upr->upr_data_h, FLUSH);
 945                 break;
 946         case SLIC_UPR_PING:
 947                 slic_reg32_write(&slic_regs->slic_ping, 1, FLUSH);
 948                 break;
 949         }
 950 }
 951
 952 static int slic_upr_request(struct adapter *adapter,
 953                      u32 upr_request,
 954                      u32 upr_data,
 955                      u32 upr_data_h,
 956                      u32 upr_buffer, u32 upr_buffer_h)
 957 {
 958         unsigned long flags;
 959         int rc;
 960
 961         spin_lock_irqsave(&adapter->upr_lock, flags);
 962         rc = slic_upr_queue_request(adapter,
 963                                         upr_request,
 964                                         upr_data,
 965                                         upr_data_h, upr_buffer, upr_buffer_h);
 966         if (rc)
 967                 goto err_unlock_irq;
 968
 969         slic_upr_start(adapter);
 970 err_unlock_irq:
 971         spin_unlock_irqrestore(&adapter->upr_lock, flags);
 972         return rc;
 973 }
 974
 975 static void slic_link_upr_complete(struct adapter *adapter, u32 isr)
 976 {
 977         u32 linkstatus = adapter->pshmem->linkstatus;
 978         uint linkup;
 979         unsigned char linkspeed;
 980         unsigned char linkduplex;
 981
 982         if ((isr & ISR_UPCERR) || (isr & ISR_UPCBSY)) {
 983                 struct slic_shmem *pshmem;
 984
 985                 pshmem = (struct slic_shmem *)(unsigned long)
 986                          adapter->phys_shmem;
 987 #if BITS_PER_LONG == 64
 988                 slic_upr_queue_request(adapter,
 989                                        SLIC_UPR_RLSR,
 990                                        SLIC_GET_ADDR_LOW(&pshmem->linkstatus),
 991                                        SLIC_GET_ADDR_HIGH(&pshmem->linkstatus),
 992                                        0, 0);
 993 #else
 994                 slic_upr_queue_request(adapter,
 995                                        SLIC_UPR_RLSR,
 996                                        (u32)&pshmem->linkstatus,
 997                                        SLIC_GET_ADDR_HIGH(pshmem), 0, 0);
 998 #endif
 999                 return;
1000         }
1001         if (adapter->state != ADAPT_UP)
1002                 return;
1003
1004         linkup = linkstatus & GIG_LINKUP ? LINK_UP : LINK_DOWN;
1005         if (linkstatus & GIG_SPEED_1000)
1006                 linkspeed = LINK_1000MB;
1007         else if (linkstatus & GIG_SPEED_100)
1008                 linkspeed = LINK_100MB;
1009         else
1010                 linkspeed = LINK_10MB;
1011
1012         if (linkstatus & GIG_FULLDUPLEX)
1013                 linkduplex = LINK_FULLD;
1014         else
1015                 linkduplex = LINK_HALFD;
1016
1017         if ((adapter->linkstate == LINK_DOWN) && (linkup == LINK_DOWN))
1018                 return;
1019
1020         /* link up event, but nothing has changed */
1021         if ((adapter->linkstate == LINK_UP) &&
1022             (linkup == LINK_UP) &&
1023             (adapter->linkspeed == linkspeed) &&
1024             (adapter->linkduplex == linkduplex))
1025                 return;
1026
1027         /* link has changed at this point */
1028
1029         /* link has gone from up to down */
1030         if (linkup == LINK_DOWN) {
1031                 adapter->linkstate = LINK_DOWN;
1032                 return;
1033         }
1034
1035         /* link has gone from down to up */
1036         adapter->linkspeed = linkspeed;
1037         adapter->linkduplex = linkduplex;
1038
1039         if (adapter->linkstate != LINK_UP) {
1040                 /* setup the mac */
1041                 slic_config_set(adapter, true);
1042                 adapter->linkstate = LINK_UP;
1043                 netif_start_queue(adapter->netdev);
1044         }
1045 }
1046
1047 static void slic_upr_request_complete(struct adapter *adapter, u32 isr)
1048 {
1049         struct sliccard *card = adapter->card;
1050         struct slic_upr *upr;
1051         unsigned long flags;
1052
1053         spin_lock_irqsave(&adapter->upr_lock, flags);
1054         upr = adapter->upr_list;
1055         if (!upr) {
1056                 spin_unlock_irqrestore(&adapter->upr_lock, flags);
1057                 return;
1058         }
1059         adapter->upr_list = upr->next;
1060         upr->next = NULL;
1061         adapter->upr_busy = 0;
1062         switch (upr->upr_request) {
1063         case SLIC_UPR_STATS:
1064                 {
1065                         struct slic_stats *slicstats =
1066                             (struct slic_stats *)&adapter->pshmem->inicstats;
1067                         struct slic_stats *newstats = slicstats;
1068                         struct slic_stats  *old = &adapter->inicstats_prev;
1069                         struct slicnet_stats *stst = &adapter->slic_stats;
1070
1071                         if (isr & ISR_UPCERR) {
1072                                 dev_err(&adapter->netdev->dev,
1073                                         "SLIC_UPR_STATS command failed isr[%x]\n",
1074                                         isr);
1075
1076                                 break;
1077                         }
1078                         UPDATE_STATS_GB(stst->tcp.xmit_tcp_segs,
1079                                         newstats->xmit_tcp_segs_gb,
1080                                         old->xmit_tcp_segs_gb);
1081
1082                         UPDATE_STATS_GB(stst->tcp.xmit_tcp_bytes,
1083                                         newstats->xmit_tcp_bytes_gb,
1084                                         old->xmit_tcp_bytes_gb);
1085
1086                         UPDATE_STATS_GB(stst->tcp.rcv_tcp_segs,
1087                                         newstats->rcv_tcp_segs_gb,
1088                                         old->rcv_tcp_segs_gb);
1089
1090                         UPDATE_STATS_GB(stst->tcp.rcv_tcp_bytes,
1091                                         newstats->rcv_tcp_bytes_gb,
1092                                         old->rcv_tcp_bytes_gb);
1093
1094                         UPDATE_STATS_GB(stst->iface.xmt_bytes,
1095                                         newstats->xmit_bytes_gb,
1096                                         old->xmit_bytes_gb);
1097
1098                         UPDATE_STATS_GB(stst->iface.xmt_ucast,
1099                                         newstats->xmit_unicasts_gb,
1100                                         old->xmit_unicasts_gb);
1101
1102                         UPDATE_STATS_GB(stst->iface.rcv_bytes,
1103                                         newstats->rcv_bytes_gb,
1104                                         old->rcv_bytes_gb);
1105
1106                         UPDATE_STATS_GB(stst->iface.rcv_ucast,
1107                                         newstats->rcv_unicasts_gb,
1108                                         old->rcv_unicasts_gb);
1109
1110                         UPDATE_STATS_GB(stst->iface.xmt_errors,
1111                                         newstats->xmit_collisions_gb,
1112                                         old->xmit_collisions_gb);
1113
1114                         UPDATE_STATS_GB(stst->iface.xmt_errors,
1115                                         newstats->xmit_excess_collisions_gb,
1116                                         old->xmit_excess_collisions_gb);
1117
1118                         UPDATE_STATS_GB(stst->iface.xmt_errors,
1119                                         newstats->xmit_other_error_gb,
1120                                         old->xmit_other_error_gb);
1121
1122                         UPDATE_STATS_GB(stst->iface.rcv_errors,
1123                                         newstats->rcv_other_error_gb,
1124                                         old->rcv_other_error_gb);
1125
1126                         UPDATE_STATS_GB(stst->iface.rcv_discards,
1127                                         newstats->rcv_drops_gb,
1128                                         old->rcv_drops_gb);
1129
1130                         if (newstats->rcv_drops_gb > old->rcv_drops_gb) {
1131                                 adapter->rcv_drops +=
1132                                     (newstats->rcv_drops_gb -
1133                                      old->rcv_drops_gb);
1134                         }
1135                         memcpy(old, newstats, sizeof(struct slic_stats));
1136                         break;
1137                 }
1138         case SLIC_UPR_RLSR:
1139                 slic_link_upr_complete(adapter, isr);
1140                 break;
1141         case SLIC_UPR_RCONFIG:
1142                 break;
1143         case SLIC_UPR_PING:
1144                 card->pingstatus |= (isr & ISR_PINGDSMASK);
1145                 break;
1146         }
1147         kfree(upr);
1148         slic_upr_start(adapter);
1149         spin_unlock_irqrestore(&adapter->upr_lock, flags);
1150 }
1151
1152 static int slic_config_get(struct adapter *adapter, u32 config, u32 config_h)
1153 {
1154         return slic_upr_request(adapter, SLIC_UPR_RCONFIG, config, config_h,
1155                                 0, 0);
1156 }
1157
1158 /*
1159  * Compute a checksum of the EEPROM according to RFC 1071.
1160  */
1161 static u16 slic_eeprom_cksum(void *eeprom, unsigned len)
1162 {
1163         u16 *wp = eeprom;
1164         u32 checksum = 0;
1165
1166         while (len > 1) {
1167                 checksum += *(wp++);
1168                 len -= 2;
1169         }
1170
1171         if (len > 0)
1172                 checksum += *(u8 *)wp;
1173
1174         while (checksum >> 16)
1175                 checksum = (checksum & 0xFFFF) + ((checksum >> 16) & 0xFFFF);
1176
1177         return ~checksum;
1178 }
1179
1180 static void slic_rspqueue_free(struct adapter *adapter)
1181 {
1182         int i;
1183         struct slic_rspqueue *rspq = &adapter->rspqueue;
1184
1185         for (i = 0; i < rspq->num_pages; i++) {
1186                 if (rspq->vaddr[i]) {
1187                         pci_free_consistent(adapter->pcidev, PAGE_SIZE,
1188                                             rspq->vaddr[i], rspq->paddr[i]);
1189                 }
1190                 rspq->vaddr[i] = NULL;
1191                 rspq->paddr[i] = 0;
1192         }
1193         rspq->offset = 0;
1194         rspq->pageindex = 0;
1195         rspq->rspbuf = NULL;
1196 }
1197
1198 static int slic_rspqueue_init(struct adapter *adapter)
1199 {
1200         int i;
1201         struct slic_rspqueue *rspq = &adapter->rspqueue;
1202         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
1203         u32 paddrh = 0;
1204
1205         memset(rspq, 0, sizeof(struct slic_rspqueue));
1206
1207         rspq->num_pages = SLIC_RSPQ_PAGES_GB;
1208
1209         for (i = 0; i < rspq->num_pages; i++) {
1210                 rspq->vaddr[i] = pci_zalloc_consistent(adapter->pcidev,
1211                                                        PAGE_SIZE,
1212                                                        &rspq->paddr[i]);
1213                 if (!rspq->vaddr[i]) {
1214                         dev_err(&adapter->pcidev->dev,
1215                                 "pci_alloc_consistent failed\n");
1216                         slic_rspqueue_free(adapter);
1217                         return -ENOMEM;
1218                 }
1219
1220                 if (paddrh == 0) {
1221                         slic_reg32_write(&slic_regs->slic_rbar,
1222                                 (rspq->paddr[i] | SLIC_RSPQ_BUFSINPAGE),
1223                                 DONT_FLUSH);
1224                 } else {
1225                         slic_reg64_write(adapter, &slic_regs->slic_rbar64,
1226                                 (rspq->paddr[i] | SLIC_RSPQ_BUFSINPAGE),
1227                                 &slic_regs->slic_addr_upper,
1228                                 paddrh, DONT_FLUSH);
1229                 }
1230         }
1231         rspq->offset = 0;
1232         rspq->pageindex = 0;
1233         rspq->rspbuf = (struct slic_rspbuf *)rspq->vaddr[0];
1234         return 0;
1235 }
1236
1237 static struct slic_rspbuf *slic_rspqueue_getnext(struct adapter *adapter)
1238 {
1239         struct slic_rspqueue *rspq = &adapter->rspqueue;
1240         struct slic_rspbuf *buf;
1241
1242         if (!(rspq->rspbuf->status))
1243                 return NULL;
1244
1245         buf = rspq->rspbuf;
1246         if (++rspq->offset < SLIC_RSPQ_BUFSINPAGE) {
1247                 rspq->rspbuf++;
1248         } else {
1249                 slic_reg64_write(adapter, &adapter->slic_regs->slic_rbar64,
1250                         (rspq->paddr[rspq->pageindex] | SLIC_RSPQ_BUFSINPAGE),
1251                         &adapter->slic_regs->slic_addr_upper, 0, DONT_FLUSH);
1252                 rspq->pageindex = (rspq->pageindex + 1) % rspq->num_pages;
1253                 rspq->offset = 0;
1254                 rspq->rspbuf = (struct slic_rspbuf *)
1255                                                 rspq->vaddr[rspq->pageindex];
1256         }
1257
1258         return buf;
1259 }
1260
1261 static void slic_cmdqmem_free(struct adapter *adapter)
1262 {
1263         struct slic_cmdqmem *cmdqmem = &adapter->cmdqmem;
1264         int i;
1265
1266         for (i = 0; i < SLIC_CMDQ_MAXPAGES; i++) {
1267                 if (cmdqmem->pages[i]) {
1268                         pci_free_consistent(adapter->pcidev,
1269                                             PAGE_SIZE,
1270                                             (void *)cmdqmem->pages[i],
1271                                             cmdqmem->dma_pages[i]);
1272                 }
1273         }
1274         memset(cmdqmem, 0, sizeof(struct slic_cmdqmem));
1275 }
1276
1277 static u32 *slic_cmdqmem_addpage(struct adapter *adapter)
1278 {
1279         struct slic_cmdqmem *cmdqmem = &adapter->cmdqmem;
1280         u32 *pageaddr;
1281
1282         if (cmdqmem->pagecnt >= SLIC_CMDQ_MAXPAGES)
1283                 return NULL;
1284         pageaddr = pci_alloc_consistent(adapter->pcidev,
1285                                         PAGE_SIZE,
1286                                         &cmdqmem->dma_pages[cmdqmem->pagecnt]);
1287         if (!pageaddr)
1288                 return NULL;
1289
1290         cmdqmem->pages[cmdqmem->pagecnt] = pageaddr;
1291         cmdqmem->pagecnt++;
1292         return pageaddr;
1293 }
1294
1295 static void slic_cmdq_free(struct adapter *adapter)
1296 {
1297         struct slic_hostcmd *cmd;
1298
1299         cmd = adapter->cmdq_all.head;
1300         while (cmd) {
1301                 if (cmd->busy) {
1302                         struct sk_buff *tempskb;
1303
1304                         tempskb = cmd->skb;
1305                         if (tempskb) {
1306                                 cmd->skb = NULL;
1307                                 dev_kfree_skb_irq(tempskb);
1308                         }
1309                 }
1310                 cmd = cmd->next_all;
1311         }
1312         memset(&adapter->cmdq_all, 0, sizeof(struct slic_cmdqueue));
1313         memset(&adapter->cmdq_free, 0, sizeof(struct slic_cmdqueue));
1314         memset(&adapter->cmdq_done, 0, sizeof(struct slic_cmdqueue));
1315         slic_cmdqmem_free(adapter);
1316 }
1317
1318 static void slic_cmdq_addcmdpage(struct adapter *adapter, u32 *page)
1319 {
1320         struct slic_hostcmd *cmd;
1321         struct slic_hostcmd *prev;
1322         struct slic_hostcmd *tail;
1323         struct slic_cmdqueue *cmdq;
1324         int cmdcnt;
1325         void *cmdaddr;
1326         ulong phys_addr;
1327         u32 phys_addrl;
1328         u32 phys_addrh;
1329         struct slic_handle *pslic_handle;
1330         unsigned long flags;
1331
1332         cmdaddr = page;
1333         cmd = cmdaddr;
1334         cmdcnt = 0;
1335
1336         phys_addr = virt_to_bus((void *)page);
1337         phys_addrl = SLIC_GET_ADDR_LOW(phys_addr);
1338         phys_addrh = SLIC_GET_ADDR_HIGH(phys_addr);
1339
1340         prev = NULL;
1341         tail = cmd;
1342         while ((cmdcnt < SLIC_CMDQ_CMDSINPAGE) &&
1343                (adapter->slic_handle_ix < 256)) {
1344                 /* Allocate and initialize a SLIC_HANDLE for this command */
1345                 spin_lock_irqsave(&adapter->handle_lock, flags);
1346                 pslic_handle  =  adapter->pfree_slic_handles;
1347                 adapter->pfree_slic_handles = pslic_handle->next;
1348                 spin_unlock_irqrestore(&adapter->handle_lock, flags);
1349                 pslic_handle->type = SLIC_HANDLE_CMD;
1350                 pslic_handle->address = (void *)cmd;
1351                 pslic_handle->offset = (ushort)adapter->slic_handle_ix++;
1352                 pslic_handle->other_handle = NULL;
1353                 pslic_handle->next = NULL;
1354
1355                 cmd->pslic_handle = pslic_handle;
1356                 cmd->cmd64.hosthandle = pslic_handle->token.handle_token;
1357                 cmd->busy = false;
1358                 cmd->paddrl = phys_addrl;
1359                 cmd->paddrh = phys_addrh;
1360                 cmd->next_all = prev;
1361                 cmd->next = prev;
1362                 prev = cmd;
1363                 phys_addrl += SLIC_HOSTCMD_SIZE;
1364                 cmdaddr += SLIC_HOSTCMD_SIZE;
1365
1366                 cmd = cmdaddr;
1367                 cmdcnt++;
1368         }
1369
1370         cmdq = &adapter->cmdq_all;
1371         cmdq->count += cmdcnt;  /*  SLIC_CMDQ_CMDSINPAGE;   mooktodo */
1372         tail->next_all = cmdq->head;
1373         cmdq->head = prev;
1374         cmdq = &adapter->cmdq_free;
1375         spin_lock_irqsave(&cmdq->lock, flags);
1376         cmdq->count += cmdcnt;  /*  SLIC_CMDQ_CMDSINPAGE;   mooktodo */
1377         tail->next = cmdq->head;
1378         cmdq->head = prev;
1379         spin_unlock_irqrestore(&cmdq->lock, flags);
1380 }
1381
1382 static int slic_cmdq_init(struct adapter *adapter)
1383 {
1384         int i;
1385         u32 *pageaddr;
1386
1387         memset(&adapter->cmdq_all, 0, sizeof(struct slic_cmdqueue));
1388         memset(&adapter->cmdq_free, 0, sizeof(struct slic_cmdqueue));
1389         memset(&adapter->cmdq_done, 0, sizeof(struct slic_cmdqueue));
1390         spin_lock_init(&adapter->cmdq_all.lock);
1391         spin_lock_init(&adapter->cmdq_free.lock);
1392         spin_lock_init(&adapter->cmdq_done.lock);
1393         memset(&adapter->cmdqmem, 0, sizeof(struct slic_cmdqmem));
1394         adapter->slic_handle_ix = 1;
1395         for (i = 0; i < SLIC_CMDQ_INITPAGES; i++) {
1396                 pageaddr = slic_cmdqmem_addpage(adapter);
1397                 if (!pageaddr) {
1398                         slic_cmdq_free(adapter);
1399                         return -ENOMEM;
1400                 }
1401                 slic_cmdq_addcmdpage(adapter, pageaddr);
1402         }
1403         adapter->slic_handle_ix = 1;
1404
1405         return 0;
1406 }
1407
1408 static void slic_cmdq_reset(struct adapter *adapter)
1409 {
1410         struct slic_hostcmd *hcmd;
1411         struct sk_buff *skb;
1412         u32 outstanding;
1413         unsigned long flags;
1414
1415         spin_lock_irqsave(&adapter->cmdq_free.lock, flags);
1416         spin_lock(&adapter->cmdq_done.lock);
1417         outstanding = adapter->cmdq_all.count - adapter->cmdq_done.count;
1418         outstanding -= adapter->cmdq_free.count;
1419         hcmd = adapter->cmdq_all.head;
1420         while (hcmd) {
1421                 if (hcmd->busy) {
1422                         skb = hcmd->skb;
1423                         hcmd->busy = 0;
1424                         hcmd->skb = NULL;
1425                         dev_kfree_skb_irq(skb);
1426                 }
1427                 hcmd = hcmd->next_all;
1428         }
1429         adapter->cmdq_free.count = 0;
1430         adapter->cmdq_free.head = NULL;
1431         adapter->cmdq_free.tail = NULL;
1432         adapter->cmdq_done.count = 0;
1433         adapter->cmdq_done.head = NULL;
1434         adapter->cmdq_done.tail = NULL;
1435         adapter->cmdq_free.head = adapter->cmdq_all.head;
1436         hcmd = adapter->cmdq_all.head;
1437         while (hcmd) {
1438                 adapter->cmdq_free.count++;
1439                 hcmd->next = hcmd->next_all;
1440                 hcmd = hcmd->next_all;
1441         }
1442         if (adapter->cmdq_free.count != adapter->cmdq_all.count) {
1443                 dev_err(&adapter->netdev->dev,
1444                         "free_count %d != all count %d\n",
1445                         adapter->cmdq_free.count, adapter->cmdq_all.count);
1446         }
1447         spin_unlock(&adapter->cmdq_done.lock);
1448         spin_unlock_irqrestore(&adapter->cmdq_free.lock, flags);
1449 }
1450
1451 static void slic_cmdq_getdone(struct adapter *adapter)
1452 {
1453         struct slic_cmdqueue *done_cmdq = &adapter->cmdq_done;
1454         struct slic_cmdqueue *free_cmdq = &adapter->cmdq_free;
1455         unsigned long flags;
1456
1457         spin_lock_irqsave(&done_cmdq->lock, flags);
1458
1459         free_cmdq->head = done_cmdq->head;
1460         free_cmdq->count = done_cmdq->count;
1461         done_cmdq->head = NULL;
1462         done_cmdq->tail = NULL;
1463         done_cmdq->count = 0;
1464         spin_unlock_irqrestore(&done_cmdq->lock, flags);
1465 }
1466
1467 static struct slic_hostcmd *slic_cmdq_getfree(struct adapter *adapter)
1468 {
1469         struct slic_cmdqueue *cmdq = &adapter->cmdq_free;
1470         struct slic_hostcmd *cmd = NULL;
1471         unsigned long flags;
1472
1473 lock_and_retry:
1474         spin_lock_irqsave(&cmdq->lock, flags);
1475 retry:
1476         cmd = cmdq->head;
1477         if (cmd) {
1478                 cmdq->head = cmd->next;
1479                 cmdq->count--;
1480                 spin_unlock_irqrestore(&cmdq->lock, flags);
1481         } else {
1482                 slic_cmdq_getdone(adapter);
1483                 cmd = cmdq->head;
1484                 if (cmd) {
1485                         goto retry;
1486                 } else {
1487                         u32 *pageaddr;
1488
1489                         spin_unlock_irqrestore(&cmdq->lock, flags);
1490                         pageaddr = slic_cmdqmem_addpage(adapter);
1491                         if (pageaddr) {
1492                                 slic_cmdq_addcmdpage(adapter, pageaddr);
1493                                 goto lock_and_retry;
1494                         }
1495                 }
1496         }
1497         return cmd;
1498 }
1499
1500 static void slic_cmdq_putdone_irq(struct adapter *adapter,
1501                                 struct slic_hostcmd *cmd)
1502 {
1503         struct slic_cmdqueue *cmdq = &adapter->cmdq_done;
1504
1505         spin_lock(&cmdq->lock);
1506         cmd->busy = 0;
1507         cmd->next = cmdq->head;
1508         cmdq->head = cmd;
1509         cmdq->count++;
1510         if ((adapter->xmitq_full) && (cmdq->count > 10))
1511                 netif_wake_queue(adapter->netdev);
1512         spin_unlock(&cmdq->lock);
1513 }
1514
1515 static int slic_rcvqueue_fill(struct adapter *adapter)
1516 {
1517         void *paddr;
1518         u32 paddrl;
1519         u32 paddrh;
1520         struct slic_rcvqueue *rcvq = &adapter->rcvqueue;
1521         int i = 0;
1522         struct device *dev = &adapter->netdev->dev;
1523
1524         while (i < SLIC_RCVQ_FILLENTRIES) {
1525                 struct slic_rcvbuf *rcvbuf;
1526                 struct sk_buff *skb;
1527 #ifdef KLUDGE_FOR_4GB_BOUNDARY
1528 retry_rcvqfill:
1529 #endif
1530                 skb = alloc_skb(SLIC_RCVQ_RCVBUFSIZE, GFP_ATOMIC);
1531                 if (skb) {
1532                         paddr = (void *)(unsigned long)
1533                                 pci_map_single(adapter->pcidev,
1534                                                skb->data,
1535                                                SLIC_RCVQ_RCVBUFSIZE,
1536                                                PCI_DMA_FROMDEVICE);
1537                         paddrl = SLIC_GET_ADDR_LOW(paddr);
1538                         paddrh = SLIC_GET_ADDR_HIGH(paddr);
1539
1540                         skb->len = SLIC_RCVBUF_HEADSIZE;
1541                         rcvbuf = (struct slic_rcvbuf *)skb->head;
1542                         rcvbuf->status = 0;
1543                         skb->next = NULL;
1544 #ifdef KLUDGE_FOR_4GB_BOUNDARY
1545                         if (paddrl == 0) {
1546                                 dev_err(dev, "%s: LOW 32bits PHYSICAL ADDRESS == 0\n",
1547                                         __func__);
1548                                 dev_err(dev, "skb[%p] PROBLEM\n", skb);
1549                                 dev_err(dev, "         skbdata[%p]\n",
1550                                                 skb->data);
1551                                 dev_err(dev, "         skblen[%x]\n", skb->len);
1552                                 dev_err(dev, "         paddr[%p]\n", paddr);
1553                                 dev_err(dev, "         paddrl[%x]\n", paddrl);
1554                                 dev_err(dev, "         paddrh[%x]\n", paddrh);
1555                                 dev_err(dev, "         rcvq->head[%p]\n",
1556                                                 rcvq->head);
1557                                 dev_err(dev, "         rcvq->tail[%p]\n",
1558                                                 rcvq->tail);
1559                                 dev_err(dev, "         rcvq->count[%x]\n",
1560                                                 rcvq->count);
1561                                 dev_err(dev, "SKIP THIS SKB!!!!!!!!\n");
1562                                 goto retry_rcvqfill;
1563                         }
1564 #else
1565                         if (paddrl == 0) {
1566                                 dev_err(dev, "%s: LOW 32bits PHYSICAL ADDRESS == 0\n",
1567                                         __func__);
1568                                 dev_err(dev, "skb[%p] PROBLEM\n", skb);
1569                                 dev_err(dev, "         skbdata[%p]\n",
1570                                                 skb->data);
1571                                 dev_err(dev, "         skblen[%x]\n", skb->len);
1572                                 dev_err(dev, "         paddr[%p]\n", paddr);
1573                                 dev_err(dev, "         paddrl[%x]\n", paddrl);
1574                                 dev_err(dev, "         paddrh[%x]\n", paddrh);
1575                                 dev_err(dev, "         rcvq->head[%p]\n",
1576                                                 rcvq->head);
1577                                 dev_err(dev, "         rcvq->tail[%p]\n",
1578                                                 rcvq->tail);
1579                                 dev_err(dev, "         rcvq->count[%x]\n",
1580                                                 rcvq->count);
1581                                 dev_err(dev, "GIVE TO CARD ANYWAY\n");
1582                         }
1583 #endif
1584                         if (paddrh == 0) {
1585                                 slic_reg32_write(&adapter->slic_regs->slic_hbar,
1586                                                  (u32)paddrl, DONT_FLUSH);
1587                         } else {
1588                                 slic_reg64_write(adapter,
1589                                         &adapter->slic_regs->slic_hbar64,
1590                                         paddrl,
1591                                         &adapter->slic_regs->slic_addr_upper,
1592                                         paddrh, DONT_FLUSH);
1593                         }
1594                         if (rcvq->head)
1595                                 rcvq->tail->next = skb;
1596                         else
1597                                 rcvq->head = skb;
1598                         rcvq->tail = skb;
1599                         rcvq->count++;
1600                         i++;
1601                 } else {
1602                         dev_err(&adapter->netdev->dev,
1603                                 "slic_rcvqueue_fill could only get [%d] skbuffs\n",
1604                                 i);
1605                         break;
1606                 }
1607         }
1608         return i;
1609 }
1610
1611 static void slic_rcvqueue_free(struct adapter *adapter)
1612 {
1613         struct slic_rcvqueue *rcvq = &adapter->rcvqueue;
1614         struct sk_buff *skb;
1615
1616         while (rcvq->head) {
1617                 skb = rcvq->head;
1618                 rcvq->head = rcvq->head->next;
1619                 dev_kfree_skb(skb);
1620         }
1621         rcvq->tail = NULL;
1622         rcvq->head = NULL;
1623         rcvq->count = 0;
1624 }
1625
1626 static int slic_rcvqueue_init(struct adapter *adapter)
1627 {
1628         int i, count;
1629         struct slic_rcvqueue *rcvq = &adapter->rcvqueue;
1630
1631         rcvq->tail = NULL;
1632         rcvq->head = NULL;
1633         rcvq->size = SLIC_RCVQ_ENTRIES;
1634         rcvq->errors = 0;
1635         rcvq->count = 0;
1636         i = SLIC_RCVQ_ENTRIES / SLIC_RCVQ_FILLENTRIES;
1637         count = 0;
1638         while (i) {
1639                 count += slic_rcvqueue_fill(adapter);
1640                 i--;
1641         }
1642         if (rcvq->count < SLIC_RCVQ_MINENTRIES) {
1643                 slic_rcvqueue_free(adapter);
1644                 return -ENOMEM;
1645         }
1646         return 0;
1647 }
1648
1649 static struct sk_buff *slic_rcvqueue_getnext(struct adapter *adapter)
1650 {
1651         struct slic_rcvqueue *rcvq = &adapter->rcvqueue;
1652         struct sk_buff *skb;
1653         struct slic_rcvbuf *rcvbuf;
1654         int count;
1655
1656         if (rcvq->count) {
1657                 skb = rcvq->head;
1658                 rcvbuf = (struct slic_rcvbuf *)skb->head;
1659
1660                 if (rcvbuf->status & IRHDDR_SVALID) {
1661                         rcvq->head = rcvq->head->next;
1662                         skb->next = NULL;
1663                         rcvq->count--;
1664                 } else {
1665                         skb = NULL;
1666                 }
1667         } else {
1668                 dev_err(&adapter->netdev->dev,
1669                         "RcvQ Empty!! rcvq[%p] count[%x]\n", rcvq, rcvq->count);
1670                 skb = NULL;
1671         }
1672         while (rcvq->count < SLIC_RCVQ_FILLTHRESH) {
1673                 count = slic_rcvqueue_fill(adapter);
1674                 if (!count)
1675                         break;
1676         }
1677         if (skb)
1678                 rcvq->errors = 0;
1679         return skb;
1680 }
1681
1682 static u32 slic_rcvqueue_reinsert(struct adapter *adapter, struct sk_buff *skb)
1683 {
1684         struct slic_rcvqueue *rcvq = &adapter->rcvqueue;
1685         void *paddr;
1686         u32 paddrl;
1687         u32 paddrh;
1688         struct slic_rcvbuf *rcvbuf = (struct slic_rcvbuf *)skb->head;
1689         struct device *dev;
1690
1691         paddr = (void *)(unsigned long)
1692                 pci_map_single(adapter->pcidev, skb->head,
1693                                SLIC_RCVQ_RCVBUFSIZE, PCI_DMA_FROMDEVICE);
1694         rcvbuf->status = 0;
1695         skb->next = NULL;
1696
1697         paddrl = SLIC_GET_ADDR_LOW(paddr);
1698         paddrh = SLIC_GET_ADDR_HIGH(paddr);
1699
1700         if (paddrl == 0) {
1701                 dev = &adapter->netdev->dev;
1702                 dev_err(dev, "%s: LOW 32bits PHYSICAL ADDRESS == 0\n",
1703                         __func__);
1704                 dev_err(dev, "skb[%p] PROBLEM\n", skb);
1705                 dev_err(dev, "         skbdata[%p]\n", skb->data);
1706                 dev_err(dev, "         skblen[%x]\n", skb->len);
1707                 dev_err(dev, "         paddr[%p]\n", paddr);
1708                 dev_err(dev, "         paddrl[%x]\n", paddrl);
1709                 dev_err(dev, "         paddrh[%x]\n", paddrh);
1710                 dev_err(dev, "         rcvq->head[%p]\n", rcvq->head);
1711                 dev_err(dev, "         rcvq->tail[%p]\n", rcvq->tail);
1712                 dev_err(dev, "         rcvq->count[%x]\n", rcvq->count);
1713         }
1714         if (paddrh == 0) {
1715                 slic_reg32_write(&adapter->slic_regs->slic_hbar, (u32)paddrl,
1716                                  DONT_FLUSH);
1717         } else {
1718                 slic_reg64_write(adapter, &adapter->slic_regs->slic_hbar64,
1719                                  paddrl, &adapter->slic_regs->slic_addr_upper,
1720                                  paddrh, DONT_FLUSH);
1721         }
1722         if (rcvq->head)
1723                 rcvq->tail->next = skb;
1724         else
1725                 rcvq->head = skb;
1726         rcvq->tail = skb;
1727         rcvq->count++;
1728         return rcvq->count;
1729 }
1730
1731 /*
1732  * slic_link_event_handler -
1733  *
1734  * Initiate a link configuration sequence.  The link configuration begins
1735  * by issuing a READ_LINK_STATUS command to the Utility Processor on the
1736  * SLIC.  Since the command finishes asynchronously, the slic_upr_comlete
1737  * routine will follow it up witha UP configuration write command, which
1738  * will also complete asynchronously.
1739  *
1740  */
1741 static int slic_link_event_handler(struct adapter *adapter)
1742 {
1743         int status;
1744         struct slic_shmem *pshmem;
1745
1746         if (adapter->state != ADAPT_UP) {
1747                 /* Adapter is not operational.  Ignore.  */
1748                 return -ENODEV;
1749         }
1750
1751         pshmem = (struct slic_shmem *)(unsigned long)adapter->phys_shmem;
1752
1753 #if BITS_PER_LONG == 64
1754         status = slic_upr_request(adapter,
1755                                   SLIC_UPR_RLSR,
1756                                   SLIC_GET_ADDR_LOW(&pshmem->linkstatus),
1757                                   SLIC_GET_ADDR_HIGH(&pshmem->linkstatus),
1758                                   0, 0);
1759 #else
1760         status = slic_upr_request(adapter, SLIC_UPR_RLSR,
1761                 (u32)&pshmem->linkstatus,       /* no 4GB wrap guaranteed */
1762                                   0, 0, 0);
1763 #endif
1764         return status;
1765 }
1766
1767 static void slic_init_cleanup(struct adapter *adapter)
1768 {
1769         if (adapter->intrregistered) {
1770                 adapter->intrregistered = 0;
1771                 free_irq(adapter->netdev->irq, adapter->netdev);
1772
1773         }
1774         if (adapter->pshmem) {
1775                 pci_free_consistent(adapter->pcidev,
1776                                     sizeof(struct slic_shmem),
1777                                     adapter->pshmem, adapter->phys_shmem);
1778                 adapter->pshmem = NULL;
1779                 adapter->phys_shmem = (dma_addr_t)(unsigned long)NULL;
1780         }
1781
1782         if (adapter->pingtimerset) {
1783                 adapter->pingtimerset = 0;
1784                 del_timer(&adapter->pingtimer);
1785         }
1786
1787         slic_rspqueue_free(adapter);
1788         slic_cmdq_free(adapter);
1789         slic_rcvqueue_free(adapter);
1790 }
1791
1792 /*
1793  *  Allocate a mcast_address structure to hold the multicast address.
1794  *  Link it in.
1795  */
1796 static int slic_mcast_add_list(struct adapter *adapter, char *address)
1797 {
1798         struct mcast_address *mcaddr, *mlist;
1799
1800         /* Check to see if it already exists */
1801         mlist = adapter->mcastaddrs;
1802         while (mlist) {
1803                 if (ether_addr_equal(mlist->address, address))
1804                         return 0;
1805                 mlist = mlist->next;
1806         }
1807
1808         /* Doesn't already exist.  Allocate a structure to hold it */
1809         mcaddr = kmalloc(sizeof(struct mcast_address), GFP_ATOMIC);
1810         if (mcaddr == NULL)
1811                 return 1;
1812
1813         ether_addr_copy(mcaddr->address, address);
1814
1815         mcaddr->next = adapter->mcastaddrs;
1816         adapter->mcastaddrs = mcaddr;
1817
1818         return 0;
1819 }
1820
1821 static void slic_mcast_set_list(struct net_device *dev)
1822 {
1823         struct adapter *adapter = netdev_priv(dev);
1824         int status = 0;
1825         char *addresses;
1826         struct netdev_hw_addr *ha;
1827
1828         netdev_for_each_mc_addr(ha, dev) {
1829                 addresses = (char *)&ha->addr;
1830                 status = slic_mcast_add_list(adapter, addresses);
1831                 if (status != 0)
1832                         break;
1833                 slic_mcast_set_bit(adapter, addresses);
1834         }
1835
1836         if (adapter->devflags_prev != dev->flags) {
1837                 adapter->macopts = MAC_DIRECTED;
1838                 if (dev->flags) {
1839                         if (dev->flags & IFF_BROADCAST)
1840                                 adapter->macopts |= MAC_BCAST;
1841                         if (dev->flags & IFF_PROMISC)
1842                                 adapter->macopts |= MAC_PROMISC;
1843                         if (dev->flags & IFF_ALLMULTI)
1844                                 adapter->macopts |= MAC_ALLMCAST;
1845                         if (dev->flags & IFF_MULTICAST)
1846                                 adapter->macopts |= MAC_MCAST;
1847                 }
1848                 adapter->devflags_prev = dev->flags;
1849                 slic_config_set(adapter, true);
1850         } else {
1851                 if (status == 0)
1852                         slic_mcast_set_mask(adapter);
1853         }
1854 }
1855
1856 #define  XMIT_FAIL_LINK_STATE               1
1857 #define  XMIT_FAIL_ZERO_LENGTH              2
1858 #define  XMIT_FAIL_HOSTCMD_FAIL             3
1859
1860 static void slic_xmit_build_request(struct adapter *adapter,
1861                              struct slic_hostcmd *hcmd, struct sk_buff *skb)
1862 {
1863         struct slic_host64_cmd *ihcmd;
1864         ulong phys_addr;
1865
1866         ihcmd = &hcmd->cmd64;
1867
1868         ihcmd->flags = adapter->port << IHFLG_IFSHFT;
1869         ihcmd->command = IHCMD_XMT_REQ;
1870         ihcmd->u.slic_buffers.totlen = skb->len;
1871         phys_addr = pci_map_single(adapter->pcidev, skb->data, skb->len,
1872                         PCI_DMA_TODEVICE);
1873         ihcmd->u.slic_buffers.bufs[0].paddrl = SLIC_GET_ADDR_LOW(phys_addr);
1874         ihcmd->u.slic_buffers.bufs[0].paddrh = SLIC_GET_ADDR_HIGH(phys_addr);
1875         ihcmd->u.slic_buffers.bufs[0].length = skb->len;
1876 #if BITS_PER_LONG == 64
1877         hcmd->cmdsize = (u32)((((u64)&ihcmd->u.slic_buffers.bufs[1] -
1878                                      (u64)hcmd) + 31) >> 5);
1879 #else
1880         hcmd->cmdsize = (((u32)&ihcmd->u.slic_buffers.bufs[1] -
1881                                        (u32)hcmd) + 31) >> 5;
1882 #endif
1883 }
1884
1885 static void slic_xmit_fail(struct adapter *adapter,
1886                     struct sk_buff *skb,
1887                     void *cmd, u32 skbtype, u32 status)
1888 {
1889         if (adapter->xmitq_full)
1890                 netif_stop_queue(adapter->netdev);
1891         if ((cmd == NULL) && (status <= XMIT_FAIL_HOSTCMD_FAIL)) {
1892                 switch (status) {
1893                 case XMIT_FAIL_LINK_STATE:
1894                         dev_err(&adapter->netdev->dev,
1895                                 "reject xmit skb[%p: %x] linkstate[%s] adapter[%s:%d] card[%s:%d]\n",
1896                                 skb, skb->pkt_type,
1897                                 SLIC_LINKSTATE(adapter->linkstate),
1898                                 SLIC_ADAPTER_STATE(adapter->state),
1899                                 adapter->state,
1900                                 SLIC_CARD_STATE(adapter->card->state),
1901                                 adapter->card->state);
1902                         break;
1903                 case XMIT_FAIL_ZERO_LENGTH:
1904                         dev_err(&adapter->netdev->dev,
1905                                 "xmit_start skb->len == 0 skb[%p] type[%x]\n",
1906                                 skb, skb->pkt_type);
1907                         break;
1908                 case XMIT_FAIL_HOSTCMD_FAIL:
1909                         dev_err(&adapter->netdev->dev,
1910                                 "xmit_start skb[%p] type[%x] No host commands available\n",
1911                                 skb, skb->pkt_type);
1912                         break;
1913                 }
1914         }
1915         dev_kfree_skb(skb);
1916         adapter->netdev->stats.tx_dropped++;
1917 }
1918
1919 static void slic_rcv_handle_error(struct adapter *adapter,
1920                                         struct slic_rcvbuf *rcvbuf)
1921 {
1922         struct slic_hddr_wds *hdr = (struct slic_hddr_wds *)rcvbuf->data;
1923         struct net_device *netdev = adapter->netdev;
1924
1925         if (adapter->devid != SLIC_1GB_DEVICE_ID) {
1926                 if (hdr->frame_status14 & VRHSTAT_802OE)
1927                         adapter->if_events.oflow802++;
1928                 if (hdr->frame_status14 & VRHSTAT_TPOFLO)
1929                         adapter->if_events.Tprtoflow++;
1930                 if (hdr->frame_status_b14 & VRHSTATB_802UE)
1931                         adapter->if_events.uflow802++;
1932                 if (hdr->frame_status_b14 & VRHSTATB_RCVE) {
1933                         adapter->if_events.rcvearly++;
1934                         netdev->stats.rx_fifo_errors++;
1935                 }
1936                 if (hdr->frame_status_b14 & VRHSTATB_BUFF) {
1937                         adapter->if_events.Bufov++;
1938                         netdev->stats.rx_over_errors++;
1939                 }
1940                 if (hdr->frame_status_b14 & VRHSTATB_CARRE) {
1941                         adapter->if_events.Carre++;
1942                         netdev->stats.tx_carrier_errors++;
1943                 }
1944                 if (hdr->frame_status_b14 & VRHSTATB_LONGE)
1945                         adapter->if_events.Longe++;
1946                 if (hdr->frame_status_b14 & VRHSTATB_PREA)
1947                         adapter->if_events.Invp++;
1948                 if (hdr->frame_status_b14 & VRHSTATB_CRC) {
1949                         adapter->if_events.Crc++;
1950                         netdev->stats.rx_crc_errors++;
1951                 }
1952                 if (hdr->frame_status_b14 & VRHSTATB_DRBL)
1953                         adapter->if_events.Drbl++;
1954                 if (hdr->frame_status_b14 & VRHSTATB_CODE)
1955                         adapter->if_events.Code++;
1956                 if (hdr->frame_status_b14 & VRHSTATB_TPCSUM)
1957                         adapter->if_events.TpCsum++;
1958                 if (hdr->frame_status_b14 & VRHSTATB_TPHLEN)
1959                         adapter->if_events.TpHlen++;
1960                 if (hdr->frame_status_b14 & VRHSTATB_IPCSUM)
1961                         adapter->if_events.IpCsum++;
1962                 if (hdr->frame_status_b14 & VRHSTATB_IPLERR)
1963                         adapter->if_events.IpLen++;
1964                 if (hdr->frame_status_b14 & VRHSTATB_IPHERR)
1965                         adapter->if_events.IpHlen++;
1966         } else {
1967                 if (hdr->frame_statusGB & VGBSTAT_XPERR) {
1968                         u32 xerr = hdr->frame_statusGB >> VGBSTAT_XERRSHFT;
1969
1970                         if (xerr == VGBSTAT_XCSERR)
1971                                 adapter->if_events.TpCsum++;
1972                         if (xerr == VGBSTAT_XUFLOW)
1973                                 adapter->if_events.Tprtoflow++;
1974                         if (xerr == VGBSTAT_XHLEN)
1975                                 adapter->if_events.TpHlen++;
1976                 }
1977                 if (hdr->frame_statusGB & VGBSTAT_NETERR) {
1978                         u32 nerr =
1979                             (hdr->
1980                              frame_statusGB >> VGBSTAT_NERRSHFT) &
1981                             VGBSTAT_NERRMSK;
1982                         if (nerr == VGBSTAT_NCSERR)
1983                                 adapter->if_events.IpCsum++;
1984                         if (nerr == VGBSTAT_NUFLOW)
1985                                 adapter->if_events.IpLen++;
1986                         if (nerr == VGBSTAT_NHLEN)
1987                                 adapter->if_events.IpHlen++;
1988                 }
1989                 if (hdr->frame_statusGB & VGBSTAT_LNKERR) {
1990                         u32 lerr = hdr->frame_statusGB & VGBSTAT_LERRMSK;
1991
1992                         if (lerr == VGBSTAT_LDEARLY)
1993                                 adapter->if_events.rcvearly++;
1994                         if (lerr == VGBSTAT_LBOFLO)
1995                                 adapter->if_events.Bufov++;
1996                         if (lerr == VGBSTAT_LCODERR)
1997                                 adapter->if_events.Code++;
1998                         if (lerr == VGBSTAT_LDBLNBL)
1999                                 adapter->if_events.Drbl++;
2000                         if (lerr == VGBSTAT_LCRCERR)
2001                                 adapter->if_events.Crc++;
2002                         if (lerr == VGBSTAT_LOFLO)
2003                                 adapter->if_events.oflow802++;
2004                         if (lerr == VGBSTAT_LUFLO)
2005                                 adapter->if_events.uflow802++;
2006                 }
2007         }
2008 }
2009
2010 #define TCP_OFFLOAD_FRAME_PUSHFLAG  0x10000000
2011 #define M_FAST_PATH                 0x0040
2012
2013 static void slic_rcv_handler(struct adapter *adapter)
2014 {
2015         struct net_device *netdev = adapter->netdev;
2016         struct sk_buff *skb;
2017         struct slic_rcvbuf *rcvbuf;
2018         u32 frames = 0;
2019
2020         while ((skb = slic_rcvqueue_getnext(adapter))) {
2021                 u32 rx_bytes;
2022
2023                 rcvbuf = (struct slic_rcvbuf *)skb->head;
2024                 adapter->card->events++;
2025                 if (rcvbuf->status & IRHDDR_ERR) {
2026                         adapter->rx_errors++;
2027                         slic_rcv_handle_error(adapter, rcvbuf);
2028                         slic_rcvqueue_reinsert(adapter, skb);
2029                         continue;
2030                 }
2031
2032                 if (!slic_mac_filter(adapter, (struct ether_header *)
2033                                         rcvbuf->data)) {
2034                         slic_rcvqueue_reinsert(adapter, skb);
2035                         continue;
2036                 }
2037                 skb_pull(skb, SLIC_RCVBUF_HEADSIZE);
2038                 rx_bytes = (rcvbuf->length & IRHDDR_FLEN_MSK);
2039                 skb_put(skb, rx_bytes);
2040                 netdev->stats.rx_packets++;
2041                 netdev->stats.rx_bytes += rx_bytes;
2042 #if SLIC_OFFLOAD_IP_CHECKSUM
2043                 skb->ip_summed = CHECKSUM_UNNECESSARY;
2044 #endif
2045
2046                 skb->dev = adapter->netdev;
2047                 skb->protocol = eth_type_trans(skb, skb->dev);
2048                 netif_rx(skb);
2049
2050                 ++frames;
2051 #if SLIC_INTERRUPT_PROCESS_LIMIT
2052                 if (frames >= SLIC_RCVQ_MAX_PROCESS_ISR) {
2053                         adapter->rcv_interrupt_yields++;
2054                         break;
2055                 }
2056 #endif
2057         }
2058         adapter->max_isr_rcvs = max(adapter->max_isr_rcvs, frames);
2059 }
2060
2061 static void slic_xmit_complete(struct adapter *adapter)
2062 {
2063         struct slic_hostcmd *hcmd;
2064         struct slic_rspbuf *rspbuf;
2065         u32 frames = 0;
2066         struct slic_handle_word slic_handle_word;
2067
2068         do {
2069                 rspbuf = slic_rspqueue_getnext(adapter);
2070                 if (!rspbuf)
2071                         break;
2072                 adapter->xmit_completes++;
2073                 adapter->card->events++;
2074                 /*
2075                  * Get the complete host command buffer
2076                  */
2077                 slic_handle_word.handle_token = rspbuf->hosthandle;
2078                 hcmd =
2079                         adapter->slic_handles[slic_handle_word.handle_index].
2080                                                                         address;
2081 /*      hcmd = (struct slic_hostcmd *) rspbuf->hosthandle; */
2082                 if (hcmd->type == SLIC_CMD_DUMB) {
2083                         if (hcmd->skb)
2084                                 dev_kfree_skb_irq(hcmd->skb);
2085                         slic_cmdq_putdone_irq(adapter, hcmd);
2086                 }
2087                 rspbuf->status = 0;
2088                 rspbuf->hosthandle = 0;
2089                 frames++;
2090         } while (1);
2091         adapter->max_isr_xmits = max(adapter->max_isr_xmits, frames);
2092 }
2093
2094 static void slic_interrupt_card_up(u32 isr, struct adapter *adapter,
2095                         struct net_device *dev)
2096 {
2097         if (isr & ~ISR_IO) {
2098                 if (isr & ISR_ERR) {
2099                         adapter->error_interrupts++;
2100                         if (isr & ISR_RMISS) {
2101                                 int count;
2102                                 int pre_count;
2103                                 int errors;
2104
2105                                 struct slic_rcvqueue *rcvq =
2106                                         &adapter->rcvqueue;
2107
2108                                 adapter->error_rmiss_interrupts++;
2109
2110                                 if (!rcvq->errors)
2111                                         rcv_count = rcvq->count;
2112                                 pre_count = rcvq->count;
2113                                 errors = rcvq->errors;
2114
2115                                 while (rcvq->count < SLIC_RCVQ_FILLTHRESH) {
2116                                         count = slic_rcvqueue_fill(adapter);
2117                                         if (!count)
2118                                                 break;
2119                                 }
2120                         } else if (isr & ISR_XDROP) {
2121                                 dev_err(&dev->dev,
2122                                                 "isr & ISR_ERR [%x] ISR_XDROP\n",
2123                                                 isr);
2124                         } else {
2125                                 dev_err(&dev->dev,
2126                                                 "isr & ISR_ERR [%x]\n",
2127                                                 isr);
2128                         }
2129                 }
2130
2131                 if (isr & ISR_LEVENT) {
2132                         adapter->linkevent_interrupts++;
2133                         if (slic_link_event_handler(adapter))
2134                                 adapter->linkevent_interrupts--;
2135                 }
2136
2137                 if ((isr & ISR_UPC) || (isr & ISR_UPCERR) ||
2138                     (isr & ISR_UPCBSY)) {
2139                         adapter->upr_interrupts++;
2140                         slic_upr_request_complete(adapter, isr);
2141                 }
2142         }
2143
2144         if (isr & ISR_RCV) {
2145                 adapter->rcv_interrupts++;
2146                 slic_rcv_handler(adapter);
2147         }
2148
2149         if (isr & ISR_CMD) {
2150                 adapter->xmit_interrupts++;
2151                 slic_xmit_complete(adapter);
2152         }
2153 }
2154
2155 static irqreturn_t slic_interrupt(int irq, void *dev_id)
2156 {
2157         struct net_device *dev = dev_id;
2158         struct adapter *adapter = netdev_priv(dev);
2159         u32 isr;
2160
2161         if ((adapter->pshmem) && (adapter->pshmem->isr)) {
2162                 slic_reg32_write(&adapter->slic_regs->slic_icr,
2163                                  ICR_INT_MASK, FLUSH);
2164                 isr = adapter->isrcopy = adapter->pshmem->isr;
2165                 adapter->pshmem->isr = 0;
2166                 adapter->num_isrs++;
2167                 switch (adapter->card->state) {
2168                 case CARD_UP:
2169                         slic_interrupt_card_up(isr, adapter, dev);
2170                         break;
2171
2172                 case CARD_DOWN:
2173                         if ((isr & ISR_UPC) ||
2174                             (isr & ISR_UPCERR) || (isr & ISR_UPCBSY)) {
2175                                 adapter->upr_interrupts++;
2176                                 slic_upr_request_complete(adapter, isr);
2177                         }
2178                         break;
2179                 }
2180
2181                 adapter->isrcopy = 0;
2182                 adapter->all_reg_writes += 2;
2183                 adapter->isr_reg_writes++;
2184                 slic_reg32_write(&adapter->slic_regs->slic_isr, 0, FLUSH);
2185         } else {
2186                 adapter->false_interrupts++;
2187         }
2188         return IRQ_HANDLED;
2189 }
2190
2191 #define NORMAL_ETHFRAME     0
2192
2193 static netdev_tx_t slic_xmit_start(struct sk_buff *skb, struct net_device *dev)
2194 {
2195         struct sliccard *card;
2196         struct adapter *adapter = netdev_priv(dev);
2197         struct slic_hostcmd *hcmd = NULL;
2198         u32 status = 0;
2199         void *offloadcmd = NULL;
2200
2201         card = adapter->card;
2202         if ((adapter->linkstate != LINK_UP) ||
2203             (adapter->state != ADAPT_UP) || (card->state != CARD_UP)) {
2204                 status = XMIT_FAIL_LINK_STATE;
2205                 goto xmit_fail;
2206
2207         } else if (skb->len == 0) {
2208                 status = XMIT_FAIL_ZERO_LENGTH;
2209                 goto xmit_fail;
2210         }
2211
2212         hcmd = slic_cmdq_getfree(adapter);
2213         if (!hcmd) {
2214                 adapter->xmitq_full = 1;
2215                 status = XMIT_FAIL_HOSTCMD_FAIL;
2216                 goto xmit_fail;
2217         }
2218         hcmd->skb = skb;
2219         hcmd->busy = 1;
2220         hcmd->type = SLIC_CMD_DUMB;
2221         slic_xmit_build_request(adapter, hcmd, skb);
2222         dev->stats.tx_packets++;
2223         dev->stats.tx_bytes += skb->len;
2224
2225 #ifdef DEBUG_DUMP
2226         if (adapter->kill_card) {
2227                 struct slic_host64_cmd ihcmd;
2228
2229                 ihcmd = &hcmd->cmd64;
2230
2231                 ihcmd->flags |= 0x40;
2232                 adapter->kill_card = 0; /* only do this once */
2233         }
2234 #endif
2235         if (hcmd->paddrh == 0) {
2236                 slic_reg32_write(&adapter->slic_regs->slic_cbar,
2237                                  (hcmd->paddrl | hcmd->cmdsize), DONT_FLUSH);
2238         } else {
2239                 slic_reg64_write(adapter, &adapter->slic_regs->slic_cbar64,
2240                                  (hcmd->paddrl | hcmd->cmdsize),
2241                                  &adapter->slic_regs->slic_addr_upper,
2242                                  hcmd->paddrh, DONT_FLUSH);
2243         }
2244 xmit_done:
2245         return NETDEV_TX_OK;
2246 xmit_fail:
2247         slic_xmit_fail(adapter, skb, offloadcmd, NORMAL_ETHFRAME, status);
2248         goto xmit_done;
2249 }
2250
2251 static void slic_adapter_freeresources(struct adapter *adapter)
2252 {
2253         slic_init_cleanup(adapter);
2254         adapter->error_interrupts = 0;
2255         adapter->rcv_interrupts = 0;
2256         adapter->xmit_interrupts = 0;
2257         adapter->linkevent_interrupts = 0;
2258         adapter->upr_interrupts = 0;
2259         adapter->num_isrs = 0;
2260         adapter->xmit_completes = 0;
2261         adapter->rcv_broadcasts = 0;
2262         adapter->rcv_multicasts = 0;
2263         adapter->rcv_unicasts = 0;
2264 }
2265
2266 static int slic_adapter_allocresources(struct adapter *adapter,
2267                                        unsigned long *flags)
2268 {
2269         if (!adapter->intrregistered) {
2270                 int retval;
2271
2272                 spin_unlock_irqrestore(&slic_global.driver_lock, *flags);
2273
2274                 retval = request_irq(adapter->netdev->irq,
2275                                      &slic_interrupt,
2276                                      IRQF_SHARED,
2277                                      adapter->netdev->name, adapter->netdev);
2278
2279                 spin_lock_irqsave(&slic_global.driver_lock, *flags);
2280
2281                 if (retval) {
2282                         dev_err(&adapter->netdev->dev,
2283                                 "request_irq (%s) FAILED [%x]\n",
2284                                 adapter->netdev->name, retval);
2285                         return retval;
2286                 }
2287                 adapter->intrregistered = 1;
2288         }
2289         return 0;
2290 }
2291
2292 /*
2293  *  slic_if_init
2294  *
2295  *  Perform initialization of our slic interface.
2296  *
2297  */
2298 static int slic_if_init(struct adapter *adapter, unsigned long *flags)
2299 {
2300         struct sliccard *card = adapter->card;
2301         struct net_device *dev = adapter->netdev;
2302         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
2303         struct slic_shmem *pshmem;
2304         int rc;
2305
2306         /* adapter should be down at this point */
2307         if (adapter->state != ADAPT_DOWN) {
2308                 dev_err(&dev->dev, "%s: adapter->state != ADAPT_DOWN\n",
2309                         __func__);
2310                 rc = -EIO;
2311                 goto err;
2312         }
2313
2314         adapter->devflags_prev = dev->flags;
2315         adapter->macopts = MAC_DIRECTED;
2316         if (dev->flags) {
2317                 if (dev->flags & IFF_BROADCAST)
2318                         adapter->macopts |= MAC_BCAST;
2319                 if (dev->flags & IFF_PROMISC)
2320                         adapter->macopts |= MAC_PROMISC;
2321                 if (dev->flags & IFF_ALLMULTI)
2322                         adapter->macopts |= MAC_ALLMCAST;
2323                 if (dev->flags & IFF_MULTICAST)
2324                         adapter->macopts |= MAC_MCAST;
2325         }
2326         rc = slic_adapter_allocresources(adapter, flags);
2327         if (rc) {
2328                 dev_err(&dev->dev, "slic_adapter_allocresources FAILED %x\n",
2329                         rc);
2330                 slic_adapter_freeresources(adapter);
2331                 goto err;
2332         }
2333
2334         if (!adapter->queues_initialized) {
2335                 rc = slic_rspqueue_init(adapter);
2336                 if (rc)
2337                         goto err;
2338                 rc = slic_cmdq_init(adapter);
2339                 if (rc)
2340                         goto err;
2341                 rc = slic_rcvqueue_init(adapter);
2342                 if (rc)
2343                         goto err;
2344                 adapter->queues_initialized = 1;
2345         }
2346
2347         slic_reg32_write(&slic_regs->slic_icr, ICR_INT_OFF, FLUSH);
2348         mdelay(1);
2349
2350         if (!adapter->isp_initialized) {
2351                 unsigned long flags;
2352
2353                 pshmem = (struct slic_shmem *)(unsigned long)
2354                          adapter->phys_shmem;
2355
2356                 spin_lock_irqsave(&adapter->bit64reglock, flags);
2357
2358 #if BITS_PER_LONG == 64
2359                 slic_reg32_write(&slic_regs->slic_addr_upper,
2360                                  SLIC_GET_ADDR_HIGH(&pshmem->isr), DONT_FLUSH);
2361                 slic_reg32_write(&slic_regs->slic_isp,
2362                                  SLIC_GET_ADDR_LOW(&pshmem->isr), FLUSH);
2363 #else
2364                 slic_reg32_write(&slic_regs->slic_addr_upper, 0, DONT_FLUSH);
2365                 slic_reg32_write(&slic_regs->slic_isp, (u32)&pshmem->isr,
2366                                 FLUSH);
2367 #endif
2368                 spin_unlock_irqrestore(&adapter->bit64reglock, flags);
2369                 adapter->isp_initialized = 1;
2370         }
2371
2372         adapter->state = ADAPT_UP;
2373         if (!card->loadtimerset) {
2374                 setup_timer(&card->loadtimer, &slic_timer_load_check,
2375                             (ulong)card);
2376                 card->loadtimer.expires =
2377                     jiffies + (SLIC_LOADTIMER_PERIOD * HZ);
2378                 add_timer(&card->loadtimer);
2379
2380                 card->loadtimerset = 1;
2381         }
2382
2383         if (!adapter->pingtimerset) {
2384                 setup_timer(&adapter->pingtimer, &slic_timer_ping, (ulong)dev);
2385                 adapter->pingtimer.expires =
2386                     jiffies + (PING_TIMER_INTERVAL * HZ);
2387                 add_timer(&adapter->pingtimer);
2388                 adapter->pingtimerset = 1;
2389                 adapter->card->pingstatus = ISR_PINGMASK;
2390         }
2391
2392         /*
2393          *    clear any pending events, then enable interrupts
2394          */
2395         adapter->isrcopy = 0;
2396         adapter->pshmem->isr = 0;
2397         slic_reg32_write(&slic_regs->slic_isr, 0, FLUSH);
2398         slic_reg32_write(&slic_regs->slic_icr, ICR_INT_ON, FLUSH);
2399
2400         slic_link_config(adapter, LINK_AUTOSPEED, LINK_AUTOD);
2401         rc = slic_link_event_handler(adapter);
2402         if (rc) {
2403                 /* disable interrupts then clear pending events */
2404                 slic_reg32_write(&slic_regs->slic_icr, ICR_INT_OFF, FLUSH);
2405                 slic_reg32_write(&slic_regs->slic_isr, 0, FLUSH);
2406                 if (adapter->pingtimerset) {
2407                         del_timer(&adapter->pingtimer);
2408                         adapter->pingtimerset = 0;
2409                 }
2410                 if (card->loadtimerset) {
2411                         del_timer(&card->loadtimer);
2412                         card->loadtimerset = 0;
2413                 }
2414                 adapter->state = ADAPT_DOWN;
2415                 slic_adapter_freeresources(adapter);
2416         }
2417
2418 err:
2419         return rc;
2420 }
2421
2422 static int slic_entry_open(struct net_device *dev)
2423 {
2424         struct adapter *adapter = netdev_priv(dev);
2425         struct sliccard *card = adapter->card;
2426         unsigned long flags;
2427         int status;
2428
2429         netif_stop_queue(adapter->netdev);
2430
2431         spin_lock_irqsave(&slic_global.driver_lock, flags);
2432         if (!adapter->activated) {
2433                 card->adapters_activated++;
2434                 slic_global.num_slic_ports_active++;
2435                 adapter->activated = 1;
2436         }
2437         status = slic_if_init(adapter, &flags);
2438
2439         if (status != 0) {
2440                 if (adapter->activated) {
2441                         card->adapters_activated--;
2442                         slic_global.num_slic_ports_active--;
2443                         adapter->activated = 0;
2444                 }
2445                 goto spin_unlock;
2446         }
2447         if (!card->master)
2448                 card->master = adapter;
2449
2450 spin_unlock:
2451         spin_unlock_irqrestore(&slic_global.driver_lock, flags);
2452         return status;
2453 }
2454
2455 static void slic_card_cleanup(struct sliccard *card)
2456 {
2457         if (card->loadtimerset) {
2458                 card->loadtimerset = 0;
2459                 del_timer_sync(&card->loadtimer);
2460         }
2461
2462         kfree(card);
2463 }
2464
2465 static void slic_entry_remove(struct pci_dev *pcidev)
2466 {
2467         struct net_device *dev = pci_get_drvdata(pcidev);
2468         struct adapter *adapter = netdev_priv(dev);
2469         struct sliccard *card;
2470         struct mcast_address *mcaddr, *mlist;
2471
2472         unregister_netdev(dev);
2473
2474         slic_adapter_freeresources(adapter);
2475         slic_unmap_mmio_space(adapter);
2476
2477         /* free multicast addresses */
2478         mlist = adapter->mcastaddrs;
2479         while (mlist) {
2480                 mcaddr = mlist;
2481                 mlist = mlist->next;
2482                 kfree(mcaddr);
2483         }
2484         card = adapter->card;
2485         card->adapters_allocated--;
2486         adapter->allocated = 0;
2487         if (!card->adapters_allocated) {
2488                 struct sliccard *curr_card = slic_global.slic_card;
2489
2490                 if (curr_card == card) {
2491                         slic_global.slic_card = card->next;
2492                 } else {
2493                         while (curr_card->next != card)
2494                                 curr_card = curr_card->next;
2495                         curr_card->next = card->next;
2496                 }
2497                 slic_global.num_slic_cards--;
2498                 slic_card_cleanup(card);
2499         }
2500         free_netdev(dev);
2501         pci_release_regions(pcidev);
2502         pci_disable_device(pcidev);
2503 }
2504
2505 static int slic_entry_halt(struct net_device *dev)
2506 {
2507         struct adapter *adapter = netdev_priv(dev);
2508         struct sliccard *card = adapter->card;
2509         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
2510         unsigned long flags;
2511
2512         spin_lock_irqsave(&slic_global.driver_lock, flags);
2513         netif_stop_queue(adapter->netdev);
2514         adapter->state = ADAPT_DOWN;
2515         adapter->linkstate = LINK_DOWN;
2516         adapter->upr_list = NULL;
2517         adapter->upr_busy = 0;
2518         adapter->devflags_prev = 0;
2519         slic_reg32_write(&slic_regs->slic_icr, ICR_INT_OFF, FLUSH);
2520         adapter->all_reg_writes++;
2521         adapter->icr_reg_writes++;
2522         slic_config_clear(adapter);
2523         if (adapter->activated) {
2524                 card->adapters_activated--;
2525                 slic_global.num_slic_ports_active--;
2526                 adapter->activated = 0;
2527         }
2528 #ifdef AUTOMATIC_RESET
2529         slic_reg32_write(&slic_regs->slic_reset_iface, 0, FLUSH);
2530 #endif
2531         /*
2532          *  Reset the adapter's cmd queues
2533          */
2534         slic_cmdq_reset(adapter);
2535
2536 #ifdef AUTOMATIC_RESET
2537         if (!card->adapters_activated)
2538                 slic_card_init(card, adapter);
2539 #endif
2540
2541         spin_unlock_irqrestore(&slic_global.driver_lock, flags);
2542         return 0;
2543 }
2544
2545 static struct net_device_stats *slic_get_stats(struct net_device *dev)
2546 {
2547         struct adapter *adapter = netdev_priv(dev);
2548
2549         dev->stats.collisions = adapter->slic_stats.iface.xmit_collisions;
2550         dev->stats.rx_errors = adapter->slic_stats.iface.rcv_errors;
2551         dev->stats.tx_errors = adapter->slic_stats.iface.xmt_errors;
2552         dev->stats.rx_missed_errors = adapter->slic_stats.iface.rcv_discards;
2553         dev->stats.tx_heartbeat_errors = 0;
2554         dev->stats.tx_aborted_errors = 0;
2555         dev->stats.tx_window_errors = 0;
2556         dev->stats.tx_fifo_errors = 0;
2557         dev->stats.rx_frame_errors = 0;
2558         dev->stats.rx_length_errors = 0;
2559
2560         return &dev->stats;
2561 }
2562
2563 static int slic_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
2564 {
2565         struct adapter *adapter = netdev_priv(dev);
2566         struct ethtool_cmd edata;
2567         struct ethtool_cmd ecmd;
2568         u32 data[7];
2569         u32 intagg;
2570
2571         switch (cmd) {
2572         case SIOCSLICSETINTAGG:
2573                 if (copy_from_user(data, rq->ifr_data, 28))
2574                         return -EFAULT;
2575                 intagg = data[0];
2576                 dev_err(&dev->dev, "set interrupt aggregation to %d\n",
2577                         intagg);
2578                 slic_intagg_set(adapter, intagg);
2579                 return 0;
2580
2581         case SIOCETHTOOL:
2582                 if (copy_from_user(&ecmd, rq->ifr_data, sizeof(ecmd)))
2583                         return -EFAULT;
2584
2585                 if (ecmd.cmd == ETHTOOL_GSET) {
2586                         memset(&edata, 0, sizeof(edata));
2587                         edata.supported = (SUPPORTED_10baseT_Half |
2588                                            SUPPORTED_10baseT_Full |
2589                                            SUPPORTED_100baseT_Half |
2590                                            SUPPORTED_100baseT_Full |
2591                                            SUPPORTED_Autoneg | SUPPORTED_MII);
2592                         edata.port = PORT_MII;
2593                         edata.transceiver = XCVR_INTERNAL;
2594                         edata.phy_address = 0;
2595                         if (adapter->linkspeed == LINK_100MB)
2596                                 edata.speed = SPEED_100;
2597                         else if (adapter->linkspeed == LINK_10MB)
2598                                 edata.speed = SPEED_10;
2599                         else
2600                                 edata.speed = 0;
2601
2602                         if (adapter->linkduplex == LINK_FULLD)
2603                                 edata.duplex = DUPLEX_FULL;
2604                         else
2605                                 edata.duplex = DUPLEX_HALF;
2606
2607                         edata.autoneg = AUTONEG_ENABLE;
2608                         edata.maxtxpkt = 1;
2609                         edata.maxrxpkt = 1;
2610                         if (copy_to_user(rq->ifr_data, &edata, sizeof(edata)))
2611                                 return -EFAULT;
2612
2613                 } else if (ecmd.cmd == ETHTOOL_SSET) {
2614                         if (!capable(CAP_NET_ADMIN))
2615                                 return -EPERM;
2616
2617                         if (adapter->linkspeed == LINK_100MB)
2618                                 edata.speed = SPEED_100;
2619                         else if (adapter->linkspeed == LINK_10MB)
2620                                 edata.speed = SPEED_10;
2621                         else
2622                                 edata.speed = 0;
2623
2624                         if (adapter->linkduplex == LINK_FULLD)
2625                                 edata.duplex = DUPLEX_FULL;
2626                         else
2627                                 edata.duplex = DUPLEX_HALF;
2628
2629                         edata.autoneg = AUTONEG_ENABLE;
2630                         edata.maxtxpkt = 1;
2631                         edata.maxrxpkt = 1;
2632                         if ((ecmd.speed != edata.speed) ||
2633                             (ecmd.duplex != edata.duplex)) {
2634                                 u32 speed;
2635                                 u32 duplex;
2636
2637                                 if (ecmd.speed == SPEED_10)
2638                                         speed = 0;
2639                                 else
2640                                         speed = PCR_SPEED_100;
2641                                 if (ecmd.duplex == DUPLEX_FULL)
2642                                         duplex = PCR_DUPLEX_FULL;
2643                                 else
2644                                         duplex = 0;
2645                                 slic_link_config(adapter, speed, duplex);
2646                                 if (slic_link_event_handler(adapter))
2647                                         return -EFAULT;
2648                         }
2649                 }
2650                 return 0;
2651         default:
2652                 return -EOPNOTSUPP;
2653         }
2654 }
2655
2656 static void slic_config_pci(struct pci_dev *pcidev)
2657 {
2658         u16 pci_command;
2659         u16 new_command;
2660
2661         pci_read_config_word(pcidev, PCI_COMMAND, &pci_command);
2662
2663         new_command = pci_command | PCI_COMMAND_MASTER
2664             | PCI_COMMAND_MEMORY
2665             | PCI_COMMAND_INVALIDATE
2666             | PCI_COMMAND_PARITY | PCI_COMMAND_SERR | PCI_COMMAND_FAST_BACK;
2667         if (pci_command != new_command)
2668                 pci_write_config_word(pcidev, PCI_COMMAND, new_command);
2669 }
2670
2671 static int slic_card_init(struct sliccard *card, struct adapter *adapter)
2672 {
2673         __iomem struct slic_regs *slic_regs = adapter->slic_regs;
2674         struct slic_eeprom *peeprom;
2675         struct oslic_eeprom *pOeeprom;
2676         dma_addr_t phys_config;
2677         u32 phys_configh;
2678         u32 phys_configl;
2679         u32 i = 0;
2680         struct slic_shmem *pshmem;
2681         int status;
2682         uint macaddrs = card->card_size;
2683         ushort eecodesize;
2684         ushort dramsize;
2685         ushort ee_chksum;
2686         ushort calc_chksum;
2687         struct slic_config_mac *pmac;
2688         unsigned char fruformat;
2689         unsigned char oemfruformat;
2690         struct atk_fru *patkfru;
2691         union oemfru *poemfru;
2692         unsigned long flags;
2693
2694         /* Reset everything except PCI configuration space */
2695         slic_soft_reset(adapter);
2696
2697         /* Download the microcode */
2698         status = slic_card_download(adapter);
2699         if (status)
2700                 return status;
2701
2702         if (!card->config_set) {
2703                 peeprom = pci_alloc_consistent(adapter->pcidev,
2704                                                sizeof(struct slic_eeprom),
2705                                                &phys_config);
2706
2707                 phys_configl = SLIC_GET_ADDR_LOW(phys_config);
2708                 phys_configh = SLIC_GET_ADDR_HIGH(phys_config);
2709
2710                 if (!peeprom) {
2711                         dev_err(&adapter->pcidev->dev,
2712                                 "Failed to allocate DMA memory for EEPROM.\n");
2713                         return -ENOMEM;
2714                 }
2715
2716                 memset(peeprom, 0, sizeof(struct slic_eeprom));
2717
2718                 slic_reg32_write(&slic_regs->slic_icr, ICR_INT_OFF, FLUSH);
2719                 mdelay(1);
2720                 pshmem = (struct slic_shmem *)(unsigned long)
2721                          adapter->phys_shmem;
2722
2723                 spin_lock_irqsave(&adapter->bit64reglock, flags);
2724                 slic_reg32_write(&slic_regs->slic_addr_upper,
2725                                  SLIC_GET_ADDR_HIGH(&pshmem->isr), DONT_FLUSH);
2726                 slic_reg32_write(&slic_regs->slic_isp,
2727                                  SLIC_GET_ADDR_LOW(&pshmem->isr), FLUSH);
2728                 spin_unlock_irqrestore(&adapter->bit64reglock, flags);
2729
2730                 status = slic_config_get(adapter, phys_configl, phys_configh);
2731                 if (status) {
2732                         dev_err(&adapter->pcidev->dev,
2733                                 "Failed to fetch config data from device.\n");
2734                         goto card_init_err;
2735                 }
2736
2737                 for (;;) {
2738                         if (adapter->pshmem->isr) {
2739                                 if (adapter->pshmem->isr & ISR_UPC) {
2740                                         adapter->pshmem->isr = 0;
2741                                         slic_reg64_write(adapter,
2742                                                 &slic_regs->slic_isp, 0,
2743                                                 &slic_regs->slic_addr_upper,
2744                                                 0, FLUSH);
2745                                         slic_reg32_write(&slic_regs->slic_isr,
2746                                                          0, FLUSH);
2747
2748                                         slic_upr_request_complete(adapter, 0);
2749                                         break;
2750                                 }
2751
2752                                 adapter->pshmem->isr = 0;
2753                                 slic_reg32_write(&slic_regs->slic_isr,
2754                                                  0, FLUSH);
2755                         } else {
2756                                 mdelay(1);
2757                                 i++;
2758                                 if (i > 5000) {
2759                                         dev_err(&adapter->pcidev->dev,
2760                                                 "Fetch of config data timed out.\n");
2761                                         slic_reg64_write(adapter,
2762                                                 &slic_regs->slic_isp, 0,
2763                                                 &slic_regs->slic_addr_upper,
2764                                                 0, FLUSH);
2765                                         status = -EINVAL;
2766                                         goto card_init_err;
2767                                 }
2768                         }
2769                 }
2770
2771                 switch (adapter->devid) {
2772                 /* Oasis card */
2773                 case SLIC_2GB_DEVICE_ID:
2774                         /* extract EEPROM data and pointers to EEPROM data */
2775                         pOeeprom = (struct oslic_eeprom *)peeprom;
2776                         eecodesize = pOeeprom->EecodeSize;
2777                         dramsize = pOeeprom->DramSize;
2778                         pmac = pOeeprom->MacInfo;
2779                         fruformat = pOeeprom->FruFormat;
2780                         patkfru = &pOeeprom->AtkFru;
2781                         oemfruformat = pOeeprom->OemFruFormat;
2782                         poemfru = &pOeeprom->OemFru;
2783                         macaddrs = 2;
2784                         /*
2785                          * Minor kludge for Oasis card
2786                          * get 2 MAC addresses from the
2787                          * EEPROM to ensure that function 1
2788                          * gets the Port 1 MAC address
2789                          */
2790                         break;
2791                 default:
2792                         /* extract EEPROM data and pointers to EEPROM data */
2793                         eecodesize = peeprom->EecodeSize;
2794                         dramsize = peeprom->DramSize;
2795                         pmac = peeprom->u2.mac.MacInfo;
2796                         fruformat = peeprom->FruFormat;
2797                         patkfru = &peeprom->AtkFru;
2798                         oemfruformat = peeprom->OemFruFormat;
2799                         poemfru = &peeprom->OemFru;
2800                         break;
2801                 }
2802
2803                 card->config.EepromValid = false;
2804
2805                 /*  see if the EEPROM is valid by checking it's checksum */
2806                 if ((eecodesize <= MAX_EECODE_SIZE) &&
2807                     (eecodesize >= MIN_EECODE_SIZE)) {
2808
2809                         ee_chksum =
2810                             *(u16 *)((char *)peeprom + (eecodesize - 2));
2811                         /*
2812                          *  calculate the EEPROM checksum
2813                          */
2814                         calc_chksum = slic_eeprom_cksum(peeprom,
2815                                                         eecodesize - 2);
2816                         /*
2817                          *  if the ucdoe chksum flag bit worked,
2818                          *  we wouldn't need this
2819                          */
2820                         if (ee_chksum == calc_chksum)
2821                                 card->config.EepromValid = true;
2822                 }
2823                 /*  copy in the DRAM size */
2824                 card->config.DramSize = dramsize;
2825
2826                 /*  copy in the MAC address(es) */
2827                 for (i = 0; i < macaddrs; i++) {
2828                         memcpy(&card->config.MacInfo[i],
2829                                &pmac[i], sizeof(struct slic_config_mac));
2830                 }
2831
2832                 /*  copy the Alacritech FRU information */
2833                 card->config.FruFormat = fruformat;
2834                 memcpy(&card->config.AtkFru, patkfru,
2835                                                 sizeof(struct atk_fru));
2836
2837                 pci_free_consistent(adapter->pcidev,
2838                                     sizeof(struct slic_eeprom),
2839                                     peeprom, phys_config);
2840
2841                 if (!card->config.EepromValid) {
2842                         slic_reg64_write(adapter, &slic_regs->slic_isp, 0,
2843                                          &slic_regs->slic_addr_upper,
2844                                          0, FLUSH);
2845                         dev_err(&adapter->pcidev->dev, "EEPROM invalid.\n");
2846                         return -EINVAL;
2847                 }
2848
2849                 card->config_set = 1;
2850         }
2851
2852         status = slic_card_download_gbrcv(adapter);
2853         if (status)
2854                 return status;
2855
2856         if (slic_global.dynamic_intagg)
2857                 slic_intagg_set(adapter, 0);
2858         else
2859                 slic_intagg_set(adapter, adapter->intagg_delay);
2860
2861         /*
2862          *  Initialize ping status to "ok"
2863          */
2864         card->pingstatus = ISR_PINGMASK;
2865
2866         /*
2867          * Lastly, mark our card state as up and return success
2868          */
2869         card->state = CARD_UP;
2870         card->reset_in_progress = 0;
2871
2872         return 0;
2873
2874 card_init_err:
2875         pci_free_consistent(adapter->pcidev, sizeof(struct slic_eeprom),
2876                             peeprom, phys_config);
2877         return status;
2878 }
2879
2880 static int slic_get_coalesce(struct net_device *dev,
2881                              struct ethtool_coalesce *coalesce)
2882 {
2883         struct adapter *adapter = netdev_priv(dev);
2884
2885         adapter->intagg_delay = coalesce->rx_coalesce_usecs;
2886         adapter->dynamic_intagg = coalesce->use_adaptive_rx_coalesce;
2887         return 0;
2888 }
2889
2890 static int slic_set_coalesce(struct net_device *dev,
2891                              struct ethtool_coalesce *coalesce)
2892 {
2893         struct adapter *adapter = netdev_priv(dev);
2894
2895         coalesce->rx_coalesce_usecs = adapter->intagg_delay;
2896         coalesce->use_adaptive_rx_coalesce = adapter->dynamic_intagg;
2897         return 0;
2898 }
2899
2900 static void slic_init_driver(void)
2901 {
2902         if (slic_first_init) {
2903                 slic_first_init = 0;
2904                 spin_lock_init(&slic_global.driver_lock);
2905         }
2906 }
2907
2908 static void slic_init_adapter(struct net_device *netdev,
2909                               struct pci_dev *pcidev,
2910                               const struct pci_device_id *pci_tbl_entry,
2911                               void __iomem *memaddr, int chip_idx)
2912 {
2913         ushort index;
2914         struct slic_handle *pslic_handle;
2915         struct adapter *adapter = netdev_priv(netdev);
2916
2917 /*      adapter->pcidev = pcidev;*/
2918         adapter->vendid = pci_tbl_entry->vendor;
2919         adapter->devid = pci_tbl_entry->device;
2920         adapter->subsysid = pci_tbl_entry->subdevice;
2921         adapter->busnumber = pcidev->bus->number;
2922         adapter->slotnumber = ((pcidev->devfn >> 3) & 0x1F);
2923         adapter->functionnumber = (pcidev->devfn & 0x7);
2924         adapter->slic_regs = memaddr;
2925         adapter->irq = pcidev->irq;
2926 /*      adapter->netdev = netdev;*/
2927         adapter->chipid = chip_idx;
2928         adapter->port = 0;      /*adapter->functionnumber;*/
2929         adapter->cardindex = adapter->port;
2930         spin_lock_init(&adapter->upr_lock);
2931         spin_lock_init(&adapter->bit64reglock);
2932         spin_lock_init(&adapter->adapter_lock);
2933         spin_lock_init(&adapter->reset_lock);
2934         spin_lock_init(&adapter->handle_lock);
2935
2936         adapter->card_size = 1;
2937         /*
2938          * Initialize slic_handle array
2939          */
2940         /*
2941          * Start with 1.  0 is an invalid host handle.
2942          */
2943         for (index = 1, pslic_handle = &adapter->slic_handles[1];
2944              index < SLIC_CMDQ_MAXCMDS; index++, pslic_handle++) {
2945
2946                 pslic_handle->token.handle_index = index;
2947                 pslic_handle->type = SLIC_HANDLE_FREE;
2948                 pslic_handle->next = adapter->pfree_slic_handles;
2949                 adapter->pfree_slic_handles = pslic_handle;
2950         }
2951         adapter->pshmem = (struct slic_shmem *)
2952                                         pci_alloc_consistent(adapter->pcidev,
2953                                         sizeof(struct slic_shmem),
2954                                         &adapter->
2955                                         phys_shmem);
2956         if (adapter->pshmem)
2957                 memset(adapter->pshmem, 0, sizeof(struct slic_shmem));
2958 }
2959
2960 static const struct net_device_ops slic_netdev_ops = {
2961         .ndo_open               = slic_entry_open,
2962         .ndo_stop               = slic_entry_halt,
2963         .ndo_start_xmit         = slic_xmit_start,
2964         .ndo_do_ioctl           = slic_ioctl,
2965         .ndo_set_mac_address    = slic_mac_set_address,
2966         .ndo_get_stats          = slic_get_stats,
2967         .ndo_set_rx_mode        = slic_mcast_set_list,
2968         .ndo_validate_addr      = eth_validate_addr,
2969         .ndo_change_mtu         = eth_change_mtu,
2970 };
2971
2972 static u32 slic_card_locate(struct adapter *adapter)
2973 {
2974         struct sliccard *card = slic_global.slic_card;
2975         struct physcard *physcard = slic_global.phys_card;
2976         ushort card_hostid;
2977         u16 __iomem *hostid_reg;
2978         uint i;
2979         uint rdhostid_offset = 0;
2980
2981         switch (adapter->devid) {
2982         case SLIC_2GB_DEVICE_ID:
2983                 rdhostid_offset = SLIC_RDHOSTID_2GB;
2984                 break;
2985         case SLIC_1GB_DEVICE_ID:
2986                 rdhostid_offset = SLIC_RDHOSTID_1GB;
2987                 break;
2988         default:
2989                 return -ENODEV;
2990         }
2991
2992         hostid_reg =
2993             (u16 __iomem *)(((u8 __iomem *)(adapter->slic_regs)) +
2994             rdhostid_offset);
2995
2996         /* read the 16 bit hostid from SRAM */
2997         card_hostid = (ushort)readw(hostid_reg);
2998
2999         /* Initialize a new card structure if need be */
3000         if (card_hostid == SLIC_HOSTID_DEFAULT) {
3001                 card = kzalloc(sizeof(struct sliccard), GFP_KERNEL);
3002                 if (card == NULL)
3003                         return -ENOMEM;
3004
3005                 card->next = slic_global.slic_card;
3006                 slic_global.slic_card = card;
3007                 card->busnumber = adapter->busnumber;
3008                 card->slotnumber = adapter->slotnumber;
3009
3010                 /* Find an available cardnum */
3011                 for (i = 0; i < SLIC_MAX_CARDS; i++) {
3012                         if (slic_global.cardnuminuse[i] == 0) {
3013                                 slic_global.cardnuminuse[i] = 1;
3014                                 card->cardnum = i;
3015                                 break;
3016                         }
3017                 }
3018                 slic_global.num_slic_cards++;
3019         } else {
3020                 /* Card exists, find the card this adapter belongs to */
3021                 while (card) {
3022                         if (card->cardnum == card_hostid)
3023                                 break;
3024                         card = card->next;
3025                 }
3026         }
3027
3028         if (!card)
3029                 return -ENXIO;
3030         /* Put the adapter in the card's adapter list */
3031         if (!card->adapter[adapter->port]) {
3032                 card->adapter[adapter->port] = adapter;
3033                 adapter->card = card;
3034         }
3035
3036         card->card_size = 1;    /* one port per *logical* card */
3037
3038         while (physcard) {
3039                 for (i = 0; i < SLIC_MAX_PORTS; i++) {
3040                         if (physcard->adapter[i])
3041                                 break;
3042                 }
3043                 if (i == SLIC_MAX_PORTS)
3044                         break;
3045
3046                 if (physcard->adapter[i]->slotnumber == adapter->slotnumber)
3047                         break;
3048                 physcard = physcard->next;
3049         }
3050         if (!physcard) {
3051                 /* no structure allocated for this physical card yet */
3052                 physcard = kzalloc(sizeof(struct physcard), GFP_ATOMIC);
3053                 if (!physcard) {
3054                         if (card_hostid == SLIC_HOSTID_DEFAULT)
3055                                 kfree(card);
3056                         return -ENOMEM;
3057                 }
3058
3059                 physcard->next = slic_global.phys_card;
3060                 slic_global.phys_card = physcard;
3061                 physcard->adapters_allocd = 1;
3062         } else {
3063                 physcard->adapters_allocd++;
3064         }
3065         /* Note - this is ZERO relative */
3066         adapter->physport = physcard->adapters_allocd - 1;
3067
3068         physcard->adapter[adapter->physport] = adapter;
3069         adapter->physcard = physcard;
3070
3071         return 0;
3072 }
3073
3074 static int slic_entry_probe(struct pci_dev *pcidev,
3075                                const struct pci_device_id *pci_tbl_entry)
3076 {
3077         static int cards_found;
3078         static int did_version;
3079         int err = -ENODEV;
3080         struct net_device *netdev;
3081         struct adapter *adapter;
3082         void __iomem *memmapped_ioaddr = NULL;
3083         ulong mmio_start = 0;
3084         ulong mmio_len = 0;
3085         struct sliccard *card = NULL;
3086         int pci_using_dac = 0;
3087
3088         err = pci_enable_device(pcidev);
3089
3090         if (err)
3091                 return err;
3092
3093         if (did_version++ == 0) {
3094                 dev_info(&pcidev->dev, "%s\n", slic_banner);
3095                 dev_info(&pcidev->dev, "%s\n", slic_proc_version);
3096         }
3097
3098         if (!pci_set_dma_mask(pcidev, DMA_BIT_MASK(64))) {
3099                 pci_using_dac = 1;
3100                 err = pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(64));
3101                 if (err) {
3102                         dev_err(&pcidev->dev, "unable to obtain 64-bit DMA for consistent allocations\n");
3103                         goto err_out_disable_pci;
3104                 }
3105         } else {
3106                 err = pci_set_dma_mask(pcidev, DMA_BIT_MASK(32));
3107                 if (err) {
3108                         dev_err(&pcidev->dev, "no usable DMA configuration\n");
3109                         goto err_out_disable_pci;
3110                 }
3111                 pci_using_dac = 0;
3112                 pci_set_consistent_dma_mask(pcidev, DMA_BIT_MASK(32));
3113         }
3114
3115         err = pci_request_regions(pcidev, DRV_NAME);
3116         if (err) {
3117                 dev_err(&pcidev->dev, "can't obtain PCI resources\n");
3118                 goto err_out_disable_pci;
3119         }
3120
3121         pci_set_master(pcidev);
3122
3123         netdev = alloc_etherdev(sizeof(struct adapter));
3124         if (!netdev) {
3125                 err = -ENOMEM;
3126                 goto err_out_exit_slic_probe;
3127         }
3128
3129         netdev->ethtool_ops = &slic_ethtool_ops;
3130         SET_NETDEV_DEV(netdev, &pcidev->dev);
3131
3132         pci_set_drvdata(pcidev, netdev);
3133         adapter = netdev_priv(netdev);
3134         adapter->netdev = netdev;
3135         adapter->pcidev = pcidev;
3136         slic_global.dynamic_intagg = adapter->dynamic_intagg;
3137         if (pci_using_dac)
3138                 netdev->features |= NETIF_F_HIGHDMA;
3139
3140         mmio_start = pci_resource_start(pcidev, 0);
3141         mmio_len = pci_resource_len(pcidev, 0);
3142
3143 /*      memmapped_ioaddr =  (u32)ioremap_nocache(mmio_start, mmio_len);*/
3144         memmapped_ioaddr = ioremap(mmio_start, mmio_len);
3145         if (!memmapped_ioaddr) {
3146                 dev_err(&pcidev->dev, "cannot remap MMIO region %lx @ %lx\n",
3147                         mmio_len, mmio_start);
3148                 err = -ENOMEM;
3149                 goto err_out_free_netdev;
3150         }
3151
3152         slic_config_pci(pcidev);
3153
3154         slic_init_driver();
3155
3156         slic_init_adapter(netdev,
3157                           pcidev, pci_tbl_entry, memmapped_ioaddr, cards_found);
3158
3159         err = slic_card_locate(adapter);
3160         if (err) {
3161                 dev_err(&pcidev->dev, "cannot locate card\n");
3162                 goto err_out_unmap;
3163         }
3164
3165         card = adapter->card;
3166
3167         if (!adapter->allocated) {
3168                 card->adapters_allocated++;
3169                 adapter->allocated = 1;
3170         }
3171
3172         err = slic_card_init(card, adapter);
3173         if (err)
3174                 goto err_out_unmap;
3175
3176         slic_adapter_set_hwaddr(adapter);
3177
3178         netdev->base_addr = (unsigned long)memmapped_ioaddr;
3179         netdev->irq = adapter->irq;
3180         netdev->netdev_ops = &slic_netdev_ops;
3181
3182         strcpy(netdev->name, "eth%d");
3183         err = register_netdev(netdev);
3184         if (err) {
3185                 dev_err(&pcidev->dev, "Cannot register net device, aborting.\n");
3186                 goto err_out_unmap;
3187         }
3188
3189         cards_found++;
3190
3191         return 0;
3192
3193 err_out_unmap:
3194         iounmap(memmapped_ioaddr);
3195 err_out_free_netdev:
3196         free_netdev(netdev);
3197 err_out_exit_slic_probe:
3198         pci_release_regions(pcidev);
3199 err_out_disable_pci:
3200         pci_disable_device(pcidev);
3201         return err;
3202 }
3203
3204 static struct pci_driver slic_driver = {
3205         .name = DRV_NAME,
3206         .id_table = slic_pci_tbl,
3207         .probe = slic_entry_probe,
3208         .remove = slic_entry_remove,
3209 };
3210
3211 static int __init slic_module_init(void)
3212 {
3213         slic_init_driver();
3214
3215         return pci_register_driver(&slic_driver);
3216 }
3217
3218 static void __exit slic_module_cleanup(void)
3219 {
3220         pci_unregister_driver(&slic_driver);
3221 }
3222
3223 static struct ethtool_ops slic_ethtool_ops = {
3224         .get_coalesce = slic_get_coalesce,
3225         .set_coalesce = slic_set_coalesce
3226 };
3227
3228 module_init(slic_module_init);
3229 module_exit(slic_module_cleanup);