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