drivers/staging/slicoss/slicoss.c

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