drivers/staging/slicoss/slicoss.c

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