drivers/staging/slicoss/slicoss.c

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