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