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