1 /* 2 * Network device driver for Cell Processor-Based Blade and Celleb platform 3 * 4 * (C) Copyright IBM Corp. 2005 5 * (C) Copyright 2006 TOSHIBA CORPORATION 6 * 7 * Authors : Utz Bacher <utz.bacher@de.ibm.com> 8 * Jens Osterkamp <Jens.Osterkamp@de.ibm.com> 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License as published by 12 * the Free Software Foundation; either version 2, or (at your option) 13 * any later version. 14 * 15 * This program is distributed in the hope that it will be useful, 16 * but WITHOUT ANY WARRANTY; without even the implied warranty of 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 18 * GNU General Public License for more details. 19 * 20 * You should have received a copy of the GNU General Public License 21 * along with this program; if not, write to the Free Software 22 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 23 */ 24 25 #include <linux/compiler.h> 26 #include <linux/crc32.h> 27 #include <linux/delay.h> 28 #include <linux/etherdevice.h> 29 #include <linux/ethtool.h> 30 #include <linux/firmware.h> 31 #include <linux/if_vlan.h> 32 #include <linux/in.h> 33 #include <linux/init.h> 34 #include <linux/interrupt.h> 35 #include <linux/gfp.h> 36 #include <linux/ioport.h> 37 #include <linux/ip.h> 38 #include <linux/kernel.h> 39 #include <linux/mii.h> 40 #include <linux/module.h> 41 #include <linux/netdevice.h> 42 #include <linux/device.h> 43 #include <linux/pci.h> 44 #include <linux/skbuff.h> 45 #include <linux/tcp.h> 46 #include <linux/types.h> 47 #include <linux/vmalloc.h> 48 #include <linux/wait.h> 49 #include <linux/workqueue.h> 50 #include <linux/bitops.h> 51 #include <asm/pci-bridge.h> 52 #include <net/checksum.h> 53 54 #include "spider_net.h" 55 56 MODULE_AUTHOR("Utz Bacher <utz.bacher@de.ibm.com> and Jens Osterkamp " \ 57 "<Jens.Osterkamp@de.ibm.com>"); 58 MODULE_DESCRIPTION("Spider Southbridge Gigabit Ethernet driver"); 59 MODULE_LICENSE("GPL"); 60 MODULE_VERSION(VERSION); 61 MODULE_FIRMWARE(SPIDER_NET_FIRMWARE_NAME); 62 63 static int rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_DEFAULT; 64 static int tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_DEFAULT; 65 66 module_param(rx_descriptors, int, 0444); 67 module_param(tx_descriptors, int, 0444); 68 69 MODULE_PARM_DESC(rx_descriptors, "number of descriptors used " \ 70 "in rx chains"); 71 MODULE_PARM_DESC(tx_descriptors, "number of descriptors used " \ 72 "in tx chain"); 73 74 char spider_net_driver_name[] = "spidernet"; 75 76 static DEFINE_PCI_DEVICE_TABLE(spider_net_pci_tbl) = { 77 { PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_SPIDER_NET, 78 PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0UL }, 79 { 0, } 80 }; 81 82 MODULE_DEVICE_TABLE(pci, spider_net_pci_tbl); 83 84 /** 85 * spider_net_read_reg - reads an SMMIO register of a card 86 * @card: device structure 87 * @reg: register to read from 88 * 89 * returns the content of the specified SMMIO register. 90 */ 91 static inline u32 92 spider_net_read_reg(struct spider_net_card *card, u32 reg) 93 { 94 /* We use the powerpc specific variants instead of readl_be() because 95 * we know spidernet is not a real PCI device and we can thus avoid the 96 * performance hit caused by the PCI workarounds. 97 */ 98 return in_be32(card->regs + reg); 99 } 100 101 /** 102 * spider_net_write_reg - writes to an SMMIO register of a card 103 * @card: device structure 104 * @reg: register to write to 105 * @value: value to write into the specified SMMIO register 106 */ 107 static inline void 108 spider_net_write_reg(struct spider_net_card *card, u32 reg, u32 value) 109 { 110 /* We use the powerpc specific variants instead of writel_be() because 111 * we know spidernet is not a real PCI device and we can thus avoid the 112 * performance hit caused by the PCI workarounds. 113 */ 114 out_be32(card->regs + reg, value); 115 } 116 117 /** 118 * spider_net_write_phy - write to phy register 119 * @netdev: adapter to be written to 120 * @mii_id: id of MII 121 * @reg: PHY register 122 * @val: value to be written to phy register 123 * 124 * spider_net_write_phy_register writes to an arbitrary PHY 125 * register via the spider GPCWOPCMD register. We assume the queue does 126 * not run full (not more than 15 commands outstanding). 127 **/ 128 static void 129 spider_net_write_phy(struct net_device *netdev, int mii_id, 130 int reg, int val) 131 { 132 struct spider_net_card *card = netdev_priv(netdev); 133 u32 writevalue; 134 135 writevalue = ((u32)mii_id << 21) | 136 ((u32)reg << 16) | ((u32)val); 137 138 spider_net_write_reg(card, SPIDER_NET_GPCWOPCMD, writevalue); 139 } 140 141 /** 142 * spider_net_read_phy - read from phy register 143 * @netdev: network device to be read from 144 * @mii_id: id of MII 145 * @reg: PHY register 146 * 147 * Returns value read from PHY register 148 * 149 * spider_net_write_phy reads from an arbitrary PHY 150 * register via the spider GPCROPCMD register 151 **/ 152 static int 153 spider_net_read_phy(struct net_device *netdev, int mii_id, int reg) 154 { 155 struct spider_net_card *card = netdev_priv(netdev); 156 u32 readvalue; 157 158 readvalue = ((u32)mii_id << 21) | ((u32)reg << 16); 159 spider_net_write_reg(card, SPIDER_NET_GPCROPCMD, readvalue); 160 161 /* we don't use semaphores to wait for an SPIDER_NET_GPROPCMPINT 162 * interrupt, as we poll for the completion of the read operation 163 * in spider_net_read_phy. Should take about 50 us */ 164 do { 165 readvalue = spider_net_read_reg(card, SPIDER_NET_GPCROPCMD); 166 } while (readvalue & SPIDER_NET_GPREXEC); 167 168 readvalue &= SPIDER_NET_GPRDAT_MASK; 169 170 return readvalue; 171 } 172 173 /** 174 * spider_net_setup_aneg - initial auto-negotiation setup 175 * @card: device structure 176 **/ 177 static void 178 spider_net_setup_aneg(struct spider_net_card *card) 179 { 180 struct mii_phy *phy = &card->phy; 181 u32 advertise = 0; 182 u16 bmsr, estat; 183 184 bmsr = spider_net_read_phy(card->netdev, phy->mii_id, MII_BMSR); 185 estat = spider_net_read_phy(card->netdev, phy->mii_id, MII_ESTATUS); 186 187 if (bmsr & BMSR_10HALF) 188 advertise |= ADVERTISED_10baseT_Half; 189 if (bmsr & BMSR_10FULL) 190 advertise |= ADVERTISED_10baseT_Full; 191 if (bmsr & BMSR_100HALF) 192 advertise |= ADVERTISED_100baseT_Half; 193 if (bmsr & BMSR_100FULL) 194 advertise |= ADVERTISED_100baseT_Full; 195 196 if ((bmsr & BMSR_ESTATEN) && (estat & ESTATUS_1000_TFULL)) 197 advertise |= SUPPORTED_1000baseT_Full; 198 if ((bmsr & BMSR_ESTATEN) && (estat & ESTATUS_1000_THALF)) 199 advertise |= SUPPORTED_1000baseT_Half; 200 201 sungem_phy_probe(phy, phy->mii_id); 202 phy->def->ops->setup_aneg(phy, advertise); 203 204 } 205 206 /** 207 * spider_net_rx_irq_off - switch off rx irq on this spider card 208 * @card: device structure 209 * 210 * switches off rx irq by masking them out in the GHIINTnMSK register 211 */ 212 static void 213 spider_net_rx_irq_off(struct spider_net_card *card) 214 { 215 u32 regvalue; 216 217 regvalue = SPIDER_NET_INT0_MASK_VALUE & (~SPIDER_NET_RXINT); 218 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, regvalue); 219 } 220 221 /** 222 * spider_net_rx_irq_on - switch on rx irq on this spider card 223 * @card: device structure 224 * 225 * switches on rx irq by enabling them in the GHIINTnMSK register 226 */ 227 static void 228 spider_net_rx_irq_on(struct spider_net_card *card) 229 { 230 u32 regvalue; 231 232 regvalue = SPIDER_NET_INT0_MASK_VALUE | SPIDER_NET_RXINT; 233 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, regvalue); 234 } 235 236 /** 237 * spider_net_set_promisc - sets the unicast address or the promiscuous mode 238 * @card: card structure 239 * 240 * spider_net_set_promisc sets the unicast destination address filter and 241 * thus either allows for non-promisc mode or promisc mode 242 */ 243 static void 244 spider_net_set_promisc(struct spider_net_card *card) 245 { 246 u32 macu, macl; 247 struct net_device *netdev = card->netdev; 248 249 if (netdev->flags & IFF_PROMISC) { 250 /* clear destination entry 0 */ 251 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR, 0); 252 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR + 0x04, 0); 253 spider_net_write_reg(card, SPIDER_NET_GMRUA0FIL15R, 254 SPIDER_NET_PROMISC_VALUE); 255 } else { 256 macu = netdev->dev_addr[0]; 257 macu <<= 8; 258 macu |= netdev->dev_addr[1]; 259 memcpy(&macl, &netdev->dev_addr[2], sizeof(macl)); 260 261 macu |= SPIDER_NET_UA_DESCR_VALUE; 262 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR, macu); 263 spider_net_write_reg(card, SPIDER_NET_GMRUAFILnR + 0x04, macl); 264 spider_net_write_reg(card, SPIDER_NET_GMRUA0FIL15R, 265 SPIDER_NET_NONPROMISC_VALUE); 266 } 267 } 268 269 /** 270 * spider_net_get_mac_address - read mac address from spider card 271 * @card: device structure 272 * 273 * reads MAC address from GMACUNIMACU and GMACUNIMACL registers 274 */ 275 static int 276 spider_net_get_mac_address(struct net_device *netdev) 277 { 278 struct spider_net_card *card = netdev_priv(netdev); 279 u32 macl, macu; 280 281 macl = spider_net_read_reg(card, SPIDER_NET_GMACUNIMACL); 282 macu = spider_net_read_reg(card, SPIDER_NET_GMACUNIMACU); 283 284 netdev->dev_addr[0] = (macu >> 24) & 0xff; 285 netdev->dev_addr[1] = (macu >> 16) & 0xff; 286 netdev->dev_addr[2] = (macu >> 8) & 0xff; 287 netdev->dev_addr[3] = macu & 0xff; 288 netdev->dev_addr[4] = (macl >> 8) & 0xff; 289 netdev->dev_addr[5] = macl & 0xff; 290 291 if (!is_valid_ether_addr(&netdev->dev_addr[0])) 292 return -EINVAL; 293 294 return 0; 295 } 296 297 /** 298 * spider_net_get_descr_status -- returns the status of a descriptor 299 * @descr: descriptor to look at 300 * 301 * returns the status as in the dmac_cmd_status field of the descriptor 302 */ 303 static inline int 304 spider_net_get_descr_status(struct spider_net_hw_descr *hwdescr) 305 { 306 return hwdescr->dmac_cmd_status & SPIDER_NET_DESCR_IND_PROC_MASK; 307 } 308 309 /** 310 * spider_net_free_chain - free descriptor chain 311 * @card: card structure 312 * @chain: address of chain 313 * 314 */ 315 static void 316 spider_net_free_chain(struct spider_net_card *card, 317 struct spider_net_descr_chain *chain) 318 { 319 struct spider_net_descr *descr; 320 321 descr = chain->ring; 322 do { 323 descr->bus_addr = 0; 324 descr->hwdescr->next_descr_addr = 0; 325 descr = descr->next; 326 } while (descr != chain->ring); 327 328 dma_free_coherent(&card->pdev->dev, chain->num_desc, 329 chain->hwring, chain->dma_addr); 330 } 331 332 /** 333 * spider_net_init_chain - alloc and link descriptor chain 334 * @card: card structure 335 * @chain: address of chain 336 * 337 * We manage a circular list that mirrors the hardware structure, 338 * except that the hardware uses bus addresses. 339 * 340 * Returns 0 on success, <0 on failure 341 */ 342 static int 343 spider_net_init_chain(struct spider_net_card *card, 344 struct spider_net_descr_chain *chain) 345 { 346 int i; 347 struct spider_net_descr *descr; 348 struct spider_net_hw_descr *hwdescr; 349 dma_addr_t buf; 350 size_t alloc_size; 351 352 alloc_size = chain->num_desc * sizeof(struct spider_net_hw_descr); 353 354 chain->hwring = dma_alloc_coherent(&card->pdev->dev, alloc_size, 355 &chain->dma_addr, GFP_KERNEL); 356 if (!chain->hwring) 357 return -ENOMEM; 358 359 memset(chain->ring, 0, chain->num_desc * sizeof(struct spider_net_descr)); 360 361 /* Set up the hardware pointers in each descriptor */ 362 descr = chain->ring; 363 hwdescr = chain->hwring; 364 buf = chain->dma_addr; 365 for (i=0; i < chain->num_desc; i++, descr++, hwdescr++) { 366 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE; 367 hwdescr->next_descr_addr = 0; 368 369 descr->hwdescr = hwdescr; 370 descr->bus_addr = buf; 371 descr->next = descr + 1; 372 descr->prev = descr - 1; 373 374 buf += sizeof(struct spider_net_hw_descr); 375 } 376 /* do actual circular list */ 377 (descr-1)->next = chain->ring; 378 chain->ring->prev = descr-1; 379 380 spin_lock_init(&chain->lock); 381 chain->head = chain->ring; 382 chain->tail = chain->ring; 383 return 0; 384 } 385 386 /** 387 * spider_net_free_rx_chain_contents - frees descr contents in rx chain 388 * @card: card structure 389 * 390 * returns 0 on success, <0 on failure 391 */ 392 static void 393 spider_net_free_rx_chain_contents(struct spider_net_card *card) 394 { 395 struct spider_net_descr *descr; 396 397 descr = card->rx_chain.head; 398 do { 399 if (descr->skb) { 400 pci_unmap_single(card->pdev, descr->hwdescr->buf_addr, 401 SPIDER_NET_MAX_FRAME, 402 PCI_DMA_BIDIRECTIONAL); 403 dev_kfree_skb(descr->skb); 404 descr->skb = NULL; 405 } 406 descr = descr->next; 407 } while (descr != card->rx_chain.head); 408 } 409 410 /** 411 * spider_net_prepare_rx_descr - Reinitialize RX descriptor 412 * @card: card structure 413 * @descr: descriptor to re-init 414 * 415 * Return 0 on success, <0 on failure. 416 * 417 * Allocates a new rx skb, iommu-maps it and attaches it to the 418 * descriptor. Mark the descriptor as activated, ready-to-use. 419 */ 420 static int 421 spider_net_prepare_rx_descr(struct spider_net_card *card, 422 struct spider_net_descr *descr) 423 { 424 struct spider_net_hw_descr *hwdescr = descr->hwdescr; 425 dma_addr_t buf; 426 int offset; 427 int bufsize; 428 429 /* we need to round up the buffer size to a multiple of 128 */ 430 bufsize = (SPIDER_NET_MAX_FRAME + SPIDER_NET_RXBUF_ALIGN - 1) & 431 (~(SPIDER_NET_RXBUF_ALIGN - 1)); 432 433 /* and we need to have it 128 byte aligned, therefore we allocate a 434 * bit more */ 435 /* allocate an skb */ 436 descr->skb = netdev_alloc_skb(card->netdev, 437 bufsize + SPIDER_NET_RXBUF_ALIGN - 1); 438 if (!descr->skb) { 439 if (netif_msg_rx_err(card) && net_ratelimit()) 440 dev_err(&card->netdev->dev, 441 "Not enough memory to allocate rx buffer\n"); 442 card->spider_stats.alloc_rx_skb_error++; 443 return -ENOMEM; 444 } 445 hwdescr->buf_size = bufsize; 446 hwdescr->result_size = 0; 447 hwdescr->valid_size = 0; 448 hwdescr->data_status = 0; 449 hwdescr->data_error = 0; 450 451 offset = ((unsigned long)descr->skb->data) & 452 (SPIDER_NET_RXBUF_ALIGN - 1); 453 if (offset) 454 skb_reserve(descr->skb, SPIDER_NET_RXBUF_ALIGN - offset); 455 /* iommu-map the skb */ 456 buf = pci_map_single(card->pdev, descr->skb->data, 457 SPIDER_NET_MAX_FRAME, PCI_DMA_FROMDEVICE); 458 if (pci_dma_mapping_error(card->pdev, buf)) { 459 dev_kfree_skb_any(descr->skb); 460 descr->skb = NULL; 461 if (netif_msg_rx_err(card) && net_ratelimit()) 462 dev_err(&card->netdev->dev, "Could not iommu-map rx buffer\n"); 463 card->spider_stats.rx_iommu_map_error++; 464 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE; 465 } else { 466 hwdescr->buf_addr = buf; 467 wmb(); 468 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_CARDOWNED | 469 SPIDER_NET_DMAC_NOINTR_COMPLETE; 470 } 471 472 return 0; 473 } 474 475 /** 476 * spider_net_enable_rxchtails - sets RX dmac chain tail addresses 477 * @card: card structure 478 * 479 * spider_net_enable_rxchtails sets the RX DMAC chain tail addresses in the 480 * chip by writing to the appropriate register. DMA is enabled in 481 * spider_net_enable_rxdmac. 482 */ 483 static inline void 484 spider_net_enable_rxchtails(struct spider_net_card *card) 485 { 486 /* assume chain is aligned correctly */ 487 spider_net_write_reg(card, SPIDER_NET_GDADCHA , 488 card->rx_chain.tail->bus_addr); 489 } 490 491 /** 492 * spider_net_enable_rxdmac - enables a receive DMA controller 493 * @card: card structure 494 * 495 * spider_net_enable_rxdmac enables the DMA controller by setting RX_DMA_EN 496 * in the GDADMACCNTR register 497 */ 498 static inline void 499 spider_net_enable_rxdmac(struct spider_net_card *card) 500 { 501 wmb(); 502 spider_net_write_reg(card, SPIDER_NET_GDADMACCNTR, 503 SPIDER_NET_DMA_RX_VALUE); 504 } 505 506 /** 507 * spider_net_disable_rxdmac - disables the receive DMA controller 508 * @card: card structure 509 * 510 * spider_net_disable_rxdmac terminates processing on the DMA controller 511 * by turing off the DMA controller, with the force-end flag set. 512 */ 513 static inline void 514 spider_net_disable_rxdmac(struct spider_net_card *card) 515 { 516 spider_net_write_reg(card, SPIDER_NET_GDADMACCNTR, 517 SPIDER_NET_DMA_RX_FEND_VALUE); 518 } 519 520 /** 521 * spider_net_refill_rx_chain - refills descriptors/skbs in the rx chains 522 * @card: card structure 523 * 524 * refills descriptors in the rx chain: allocates skbs and iommu-maps them. 525 */ 526 static void 527 spider_net_refill_rx_chain(struct spider_net_card *card) 528 { 529 struct spider_net_descr_chain *chain = &card->rx_chain; 530 unsigned long flags; 531 532 /* one context doing the refill (and a second context seeing that 533 * and omitting it) is ok. If called by NAPI, we'll be called again 534 * as spider_net_decode_one_descr is called several times. If some 535 * interrupt calls us, the NAPI is about to clean up anyway. */ 536 if (!spin_trylock_irqsave(&chain->lock, flags)) 537 return; 538 539 while (spider_net_get_descr_status(chain->head->hwdescr) == 540 SPIDER_NET_DESCR_NOT_IN_USE) { 541 if (spider_net_prepare_rx_descr(card, chain->head)) 542 break; 543 chain->head = chain->head->next; 544 } 545 546 spin_unlock_irqrestore(&chain->lock, flags); 547 } 548 549 /** 550 * spider_net_alloc_rx_skbs - Allocates rx skbs in rx descriptor chains 551 * @card: card structure 552 * 553 * Returns 0 on success, <0 on failure. 554 */ 555 static int 556 spider_net_alloc_rx_skbs(struct spider_net_card *card) 557 { 558 struct spider_net_descr_chain *chain = &card->rx_chain; 559 struct spider_net_descr *start = chain->tail; 560 struct spider_net_descr *descr = start; 561 562 /* Link up the hardware chain pointers */ 563 do { 564 descr->prev->hwdescr->next_descr_addr = descr->bus_addr; 565 descr = descr->next; 566 } while (descr != start); 567 568 /* Put at least one buffer into the chain. if this fails, 569 * we've got a problem. If not, spider_net_refill_rx_chain 570 * will do the rest at the end of this function. */ 571 if (spider_net_prepare_rx_descr(card, chain->head)) 572 goto error; 573 else 574 chain->head = chain->head->next; 575 576 /* This will allocate the rest of the rx buffers; 577 * if not, it's business as usual later on. */ 578 spider_net_refill_rx_chain(card); 579 spider_net_enable_rxdmac(card); 580 return 0; 581 582 error: 583 spider_net_free_rx_chain_contents(card); 584 return -ENOMEM; 585 } 586 587 /** 588 * spider_net_get_multicast_hash - generates hash for multicast filter table 589 * @addr: multicast address 590 * 591 * returns the hash value. 592 * 593 * spider_net_get_multicast_hash calculates a hash value for a given multicast 594 * address, that is used to set the multicast filter tables 595 */ 596 static u8 597 spider_net_get_multicast_hash(struct net_device *netdev, __u8 *addr) 598 { 599 u32 crc; 600 u8 hash; 601 char addr_for_crc[ETH_ALEN] = { 0, }; 602 int i, bit; 603 604 for (i = 0; i < ETH_ALEN * 8; i++) { 605 bit = (addr[i / 8] >> (i % 8)) & 1; 606 addr_for_crc[ETH_ALEN - 1 - i / 8] += bit << (7 - (i % 8)); 607 } 608 609 crc = crc32_be(~0, addr_for_crc, netdev->addr_len); 610 611 hash = (crc >> 27); 612 hash <<= 3; 613 hash |= crc & 7; 614 hash &= 0xff; 615 616 return hash; 617 } 618 619 /** 620 * spider_net_set_multi - sets multicast addresses and promisc flags 621 * @netdev: interface device structure 622 * 623 * spider_net_set_multi configures multicast addresses as needed for the 624 * netdev interface. It also sets up multicast, allmulti and promisc 625 * flags appropriately 626 */ 627 static void 628 spider_net_set_multi(struct net_device *netdev) 629 { 630 struct netdev_hw_addr *ha; 631 u8 hash; 632 int i; 633 u32 reg; 634 struct spider_net_card *card = netdev_priv(netdev); 635 unsigned long bitmask[SPIDER_NET_MULTICAST_HASHES / BITS_PER_LONG] = 636 {0, }; 637 638 spider_net_set_promisc(card); 639 640 if (netdev->flags & IFF_ALLMULTI) { 641 for (i = 0; i < SPIDER_NET_MULTICAST_HASHES; i++) { 642 set_bit(i, bitmask); 643 } 644 goto write_hash; 645 } 646 647 /* well, we know, what the broadcast hash value is: it's xfd 648 hash = spider_net_get_multicast_hash(netdev, netdev->broadcast); */ 649 set_bit(0xfd, bitmask); 650 651 netdev_for_each_mc_addr(ha, netdev) { 652 hash = spider_net_get_multicast_hash(netdev, ha->addr); 653 set_bit(hash, bitmask); 654 } 655 656 write_hash: 657 for (i = 0; i < SPIDER_NET_MULTICAST_HASHES / 4; i++) { 658 reg = 0; 659 if (test_bit(i * 4, bitmask)) 660 reg += 0x08; 661 reg <<= 8; 662 if (test_bit(i * 4 + 1, bitmask)) 663 reg += 0x08; 664 reg <<= 8; 665 if (test_bit(i * 4 + 2, bitmask)) 666 reg += 0x08; 667 reg <<= 8; 668 if (test_bit(i * 4 + 3, bitmask)) 669 reg += 0x08; 670 671 spider_net_write_reg(card, SPIDER_NET_GMRMHFILnR + i * 4, reg); 672 } 673 } 674 675 /** 676 * spider_net_prepare_tx_descr - fill tx descriptor with skb data 677 * @card: card structure 678 * @skb: packet to use 679 * 680 * returns 0 on success, <0 on failure. 681 * 682 * fills out the descriptor structure with skb data and len. Copies data, 683 * if needed (32bit DMA!) 684 */ 685 static int 686 spider_net_prepare_tx_descr(struct spider_net_card *card, 687 struct sk_buff *skb) 688 { 689 struct spider_net_descr_chain *chain = &card->tx_chain; 690 struct spider_net_descr *descr; 691 struct spider_net_hw_descr *hwdescr; 692 dma_addr_t buf; 693 unsigned long flags; 694 695 buf = pci_map_single(card->pdev, skb->data, skb->len, PCI_DMA_TODEVICE); 696 if (pci_dma_mapping_error(card->pdev, buf)) { 697 if (netif_msg_tx_err(card) && net_ratelimit()) 698 dev_err(&card->netdev->dev, "could not iommu-map packet (%p, %i). " 699 "Dropping packet\n", skb->data, skb->len); 700 card->spider_stats.tx_iommu_map_error++; 701 return -ENOMEM; 702 } 703 704 spin_lock_irqsave(&chain->lock, flags); 705 descr = card->tx_chain.head; 706 if (descr->next == chain->tail->prev) { 707 spin_unlock_irqrestore(&chain->lock, flags); 708 pci_unmap_single(card->pdev, buf, skb->len, PCI_DMA_TODEVICE); 709 return -ENOMEM; 710 } 711 hwdescr = descr->hwdescr; 712 chain->head = descr->next; 713 714 descr->skb = skb; 715 hwdescr->buf_addr = buf; 716 hwdescr->buf_size = skb->len; 717 hwdescr->next_descr_addr = 0; 718 hwdescr->data_status = 0; 719 720 hwdescr->dmac_cmd_status = 721 SPIDER_NET_DESCR_CARDOWNED | SPIDER_NET_DMAC_TXFRMTL; 722 spin_unlock_irqrestore(&chain->lock, flags); 723 724 if (skb->ip_summed == CHECKSUM_PARTIAL) 725 switch (ip_hdr(skb)->protocol) { 726 case IPPROTO_TCP: 727 hwdescr->dmac_cmd_status |= SPIDER_NET_DMAC_TCP; 728 break; 729 case IPPROTO_UDP: 730 hwdescr->dmac_cmd_status |= SPIDER_NET_DMAC_UDP; 731 break; 732 } 733 734 /* Chain the bus address, so that the DMA engine finds this descr. */ 735 wmb(); 736 descr->prev->hwdescr->next_descr_addr = descr->bus_addr; 737 738 card->netdev->trans_start = jiffies; /* set netdev watchdog timer */ 739 return 0; 740 } 741 742 static int 743 spider_net_set_low_watermark(struct spider_net_card *card) 744 { 745 struct spider_net_descr *descr = card->tx_chain.tail; 746 struct spider_net_hw_descr *hwdescr; 747 unsigned long flags; 748 int status; 749 int cnt=0; 750 int i; 751 752 /* Measure the length of the queue. Measurement does not 753 * need to be precise -- does not need a lock. */ 754 while (descr != card->tx_chain.head) { 755 status = descr->hwdescr->dmac_cmd_status & SPIDER_NET_DESCR_NOT_IN_USE; 756 if (status == SPIDER_NET_DESCR_NOT_IN_USE) 757 break; 758 descr = descr->next; 759 cnt++; 760 } 761 762 /* If TX queue is short, don't even bother with interrupts */ 763 if (cnt < card->tx_chain.num_desc/4) 764 return cnt; 765 766 /* Set low-watermark 3/4th's of the way into the queue. */ 767 descr = card->tx_chain.tail; 768 cnt = (cnt*3)/4; 769 for (i=0;i<cnt; i++) 770 descr = descr->next; 771 772 /* Set the new watermark, clear the old watermark */ 773 spin_lock_irqsave(&card->tx_chain.lock, flags); 774 descr->hwdescr->dmac_cmd_status |= SPIDER_NET_DESCR_TXDESFLG; 775 if (card->low_watermark && card->low_watermark != descr) { 776 hwdescr = card->low_watermark->hwdescr; 777 hwdescr->dmac_cmd_status = 778 hwdescr->dmac_cmd_status & ~SPIDER_NET_DESCR_TXDESFLG; 779 } 780 card->low_watermark = descr; 781 spin_unlock_irqrestore(&card->tx_chain.lock, flags); 782 return cnt; 783 } 784 785 /** 786 * spider_net_release_tx_chain - processes sent tx descriptors 787 * @card: adapter structure 788 * @brutal: if set, don't care about whether descriptor seems to be in use 789 * 790 * returns 0 if the tx ring is empty, otherwise 1. 791 * 792 * spider_net_release_tx_chain releases the tx descriptors that spider has 793 * finished with (if non-brutal) or simply release tx descriptors (if brutal). 794 * If some other context is calling this function, we return 1 so that we're 795 * scheduled again (if we were scheduled) and will not lose initiative. 796 */ 797 static int 798 spider_net_release_tx_chain(struct spider_net_card *card, int brutal) 799 { 800 struct net_device *dev = card->netdev; 801 struct spider_net_descr_chain *chain = &card->tx_chain; 802 struct spider_net_descr *descr; 803 struct spider_net_hw_descr *hwdescr; 804 struct sk_buff *skb; 805 u32 buf_addr; 806 unsigned long flags; 807 int status; 808 809 while (1) { 810 spin_lock_irqsave(&chain->lock, flags); 811 if (chain->tail == chain->head) { 812 spin_unlock_irqrestore(&chain->lock, flags); 813 return 0; 814 } 815 descr = chain->tail; 816 hwdescr = descr->hwdescr; 817 818 status = spider_net_get_descr_status(hwdescr); 819 switch (status) { 820 case SPIDER_NET_DESCR_COMPLETE: 821 dev->stats.tx_packets++; 822 dev->stats.tx_bytes += descr->skb->len; 823 break; 824 825 case SPIDER_NET_DESCR_CARDOWNED: 826 if (!brutal) { 827 spin_unlock_irqrestore(&chain->lock, flags); 828 return 1; 829 } 830 831 /* fallthrough, if we release the descriptors 832 * brutally (then we don't care about 833 * SPIDER_NET_DESCR_CARDOWNED) */ 834 835 case SPIDER_NET_DESCR_RESPONSE_ERROR: 836 case SPIDER_NET_DESCR_PROTECTION_ERROR: 837 case SPIDER_NET_DESCR_FORCE_END: 838 if (netif_msg_tx_err(card)) 839 dev_err(&card->netdev->dev, "forcing end of tx descriptor " 840 "with status x%02x\n", status); 841 dev->stats.tx_errors++; 842 break; 843 844 default: 845 dev->stats.tx_dropped++; 846 if (!brutal) { 847 spin_unlock_irqrestore(&chain->lock, flags); 848 return 1; 849 } 850 } 851 852 chain->tail = descr->next; 853 hwdescr->dmac_cmd_status |= SPIDER_NET_DESCR_NOT_IN_USE; 854 skb = descr->skb; 855 descr->skb = NULL; 856 buf_addr = hwdescr->buf_addr; 857 spin_unlock_irqrestore(&chain->lock, flags); 858 859 /* unmap the skb */ 860 if (skb) { 861 pci_unmap_single(card->pdev, buf_addr, skb->len, 862 PCI_DMA_TODEVICE); 863 dev_kfree_skb(skb); 864 } 865 } 866 return 0; 867 } 868 869 /** 870 * spider_net_kick_tx_dma - enables TX DMA processing 871 * @card: card structure 872 * 873 * This routine will start the transmit DMA running if 874 * it is not already running. This routine ned only be 875 * called when queueing a new packet to an empty tx queue. 876 * Writes the current tx chain head as start address 877 * of the tx descriptor chain and enables the transmission 878 * DMA engine. 879 */ 880 static inline void 881 spider_net_kick_tx_dma(struct spider_net_card *card) 882 { 883 struct spider_net_descr *descr; 884 885 if (spider_net_read_reg(card, SPIDER_NET_GDTDMACCNTR) & 886 SPIDER_NET_TX_DMA_EN) 887 goto out; 888 889 descr = card->tx_chain.tail; 890 for (;;) { 891 if (spider_net_get_descr_status(descr->hwdescr) == 892 SPIDER_NET_DESCR_CARDOWNED) { 893 spider_net_write_reg(card, SPIDER_NET_GDTDCHA, 894 descr->bus_addr); 895 spider_net_write_reg(card, SPIDER_NET_GDTDMACCNTR, 896 SPIDER_NET_DMA_TX_VALUE); 897 break; 898 } 899 if (descr == card->tx_chain.head) 900 break; 901 descr = descr->next; 902 } 903 904 out: 905 mod_timer(&card->tx_timer, jiffies + SPIDER_NET_TX_TIMER); 906 } 907 908 /** 909 * spider_net_xmit - transmits a frame over the device 910 * @skb: packet to send out 911 * @netdev: interface device structure 912 * 913 * returns 0 on success, !0 on failure 914 */ 915 static int 916 spider_net_xmit(struct sk_buff *skb, struct net_device *netdev) 917 { 918 int cnt; 919 struct spider_net_card *card = netdev_priv(netdev); 920 921 spider_net_release_tx_chain(card, 0); 922 923 if (spider_net_prepare_tx_descr(card, skb) != 0) { 924 netdev->stats.tx_dropped++; 925 netif_stop_queue(netdev); 926 return NETDEV_TX_BUSY; 927 } 928 929 cnt = spider_net_set_low_watermark(card); 930 if (cnt < 5) 931 spider_net_kick_tx_dma(card); 932 return NETDEV_TX_OK; 933 } 934 935 /** 936 * spider_net_cleanup_tx_ring - cleans up the TX ring 937 * @card: card structure 938 * 939 * spider_net_cleanup_tx_ring is called by either the tx_timer 940 * or from the NAPI polling routine. 941 * This routine releases resources associted with transmitted 942 * packets, including updating the queue tail pointer. 943 */ 944 static void 945 spider_net_cleanup_tx_ring(struct spider_net_card *card) 946 { 947 if ((spider_net_release_tx_chain(card, 0) != 0) && 948 (card->netdev->flags & IFF_UP)) { 949 spider_net_kick_tx_dma(card); 950 netif_wake_queue(card->netdev); 951 } 952 } 953 954 /** 955 * spider_net_do_ioctl - called for device ioctls 956 * @netdev: interface device structure 957 * @ifr: request parameter structure for ioctl 958 * @cmd: command code for ioctl 959 * 960 * returns 0 on success, <0 on failure. Currently, we have no special ioctls. 961 * -EOPNOTSUPP is returned, if an unknown ioctl was requested 962 */ 963 static int 964 spider_net_do_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd) 965 { 966 switch (cmd) { 967 default: 968 return -EOPNOTSUPP; 969 } 970 } 971 972 /** 973 * spider_net_pass_skb_up - takes an skb from a descriptor and passes it on 974 * @descr: descriptor to process 975 * @card: card structure 976 * 977 * Fills out skb structure and passes the data to the stack. 978 * The descriptor state is not changed. 979 */ 980 static void 981 spider_net_pass_skb_up(struct spider_net_descr *descr, 982 struct spider_net_card *card) 983 { 984 struct spider_net_hw_descr *hwdescr = descr->hwdescr; 985 struct sk_buff *skb = descr->skb; 986 struct net_device *netdev = card->netdev; 987 u32 data_status = hwdescr->data_status; 988 u32 data_error = hwdescr->data_error; 989 990 skb_put(skb, hwdescr->valid_size); 991 992 /* the card seems to add 2 bytes of junk in front 993 * of the ethernet frame */ 994 #define SPIDER_MISALIGN 2 995 skb_pull(skb, SPIDER_MISALIGN); 996 skb->protocol = eth_type_trans(skb, netdev); 997 998 /* checksum offload */ 999 skb_checksum_none_assert(skb); 1000 if (netdev->features & NETIF_F_RXCSUM) { 1001 if ( ( (data_status & SPIDER_NET_DATA_STATUS_CKSUM_MASK) == 1002 SPIDER_NET_DATA_STATUS_CKSUM_MASK) && 1003 !(data_error & SPIDER_NET_DATA_ERR_CKSUM_MASK)) 1004 skb->ip_summed = CHECKSUM_UNNECESSARY; 1005 } 1006 1007 if (data_status & SPIDER_NET_VLAN_PACKET) { 1008 /* further enhancements: HW-accel VLAN */ 1009 } 1010 1011 /* update netdevice statistics */ 1012 netdev->stats.rx_packets++; 1013 netdev->stats.rx_bytes += skb->len; 1014 1015 /* pass skb up to stack */ 1016 netif_receive_skb(skb); 1017 } 1018 1019 static void show_rx_chain(struct spider_net_card *card) 1020 { 1021 struct spider_net_descr_chain *chain = &card->rx_chain; 1022 struct spider_net_descr *start= chain->tail; 1023 struct spider_net_descr *descr= start; 1024 struct spider_net_hw_descr *hwd = start->hwdescr; 1025 struct device *dev = &card->netdev->dev; 1026 u32 curr_desc, next_desc; 1027 int status; 1028 1029 int tot = 0; 1030 int cnt = 0; 1031 int off = start - chain->ring; 1032 int cstat = hwd->dmac_cmd_status; 1033 1034 dev_info(dev, "Total number of descrs=%d\n", 1035 chain->num_desc); 1036 dev_info(dev, "Chain tail located at descr=%d, status=0x%x\n", 1037 off, cstat); 1038 1039 curr_desc = spider_net_read_reg(card, SPIDER_NET_GDACTDPA); 1040 next_desc = spider_net_read_reg(card, SPIDER_NET_GDACNEXTDA); 1041 1042 status = cstat; 1043 do 1044 { 1045 hwd = descr->hwdescr; 1046 off = descr - chain->ring; 1047 status = hwd->dmac_cmd_status; 1048 1049 if (descr == chain->head) 1050 dev_info(dev, "Chain head is at %d, head status=0x%x\n", 1051 off, status); 1052 1053 if (curr_desc == descr->bus_addr) 1054 dev_info(dev, "HW curr desc (GDACTDPA) is at %d, status=0x%x\n", 1055 off, status); 1056 1057 if (next_desc == descr->bus_addr) 1058 dev_info(dev, "HW next desc (GDACNEXTDA) is at %d, status=0x%x\n", 1059 off, status); 1060 1061 if (hwd->next_descr_addr == 0) 1062 dev_info(dev, "chain is cut at %d\n", off); 1063 1064 if (cstat != status) { 1065 int from = (chain->num_desc + off - cnt) % chain->num_desc; 1066 int to = (chain->num_desc + off - 1) % chain->num_desc; 1067 dev_info(dev, "Have %d (from %d to %d) descrs " 1068 "with stat=0x%08x\n", cnt, from, to, cstat); 1069 cstat = status; 1070 cnt = 0; 1071 } 1072 1073 cnt ++; 1074 tot ++; 1075 descr = descr->next; 1076 } while (descr != start); 1077 1078 dev_info(dev, "Last %d descrs with stat=0x%08x " 1079 "for a total of %d descrs\n", cnt, cstat, tot); 1080 1081 #ifdef DEBUG 1082 /* Now dump the whole ring */ 1083 descr = start; 1084 do 1085 { 1086 struct spider_net_hw_descr *hwd = descr->hwdescr; 1087 status = spider_net_get_descr_status(hwd); 1088 cnt = descr - chain->ring; 1089 dev_info(dev, "Descr %d stat=0x%08x skb=%p\n", 1090 cnt, status, descr->skb); 1091 dev_info(dev, "bus addr=%08x buf addr=%08x sz=%d\n", 1092 descr->bus_addr, hwd->buf_addr, hwd->buf_size); 1093 dev_info(dev, "next=%08x result sz=%d valid sz=%d\n", 1094 hwd->next_descr_addr, hwd->result_size, 1095 hwd->valid_size); 1096 dev_info(dev, "dmac=%08x data stat=%08x data err=%08x\n", 1097 hwd->dmac_cmd_status, hwd->data_status, 1098 hwd->data_error); 1099 dev_info(dev, "\n"); 1100 1101 descr = descr->next; 1102 } while (descr != start); 1103 #endif 1104 1105 } 1106 1107 /** 1108 * spider_net_resync_head_ptr - Advance head ptr past empty descrs 1109 * 1110 * If the driver fails to keep up and empty the queue, then the 1111 * hardware wil run out of room to put incoming packets. This 1112 * will cause the hardware to skip descrs that are full (instead 1113 * of halting/retrying). Thus, once the driver runs, it wil need 1114 * to "catch up" to where the hardware chain pointer is at. 1115 */ 1116 static void spider_net_resync_head_ptr(struct spider_net_card *card) 1117 { 1118 unsigned long flags; 1119 struct spider_net_descr_chain *chain = &card->rx_chain; 1120 struct spider_net_descr *descr; 1121 int i, status; 1122 1123 /* Advance head pointer past any empty descrs */ 1124 descr = chain->head; 1125 status = spider_net_get_descr_status(descr->hwdescr); 1126 1127 if (status == SPIDER_NET_DESCR_NOT_IN_USE) 1128 return; 1129 1130 spin_lock_irqsave(&chain->lock, flags); 1131 1132 descr = chain->head; 1133 status = spider_net_get_descr_status(descr->hwdescr); 1134 for (i=0; i<chain->num_desc; i++) { 1135 if (status != SPIDER_NET_DESCR_CARDOWNED) break; 1136 descr = descr->next; 1137 status = spider_net_get_descr_status(descr->hwdescr); 1138 } 1139 chain->head = descr; 1140 1141 spin_unlock_irqrestore(&chain->lock, flags); 1142 } 1143 1144 static int spider_net_resync_tail_ptr(struct spider_net_card *card) 1145 { 1146 struct spider_net_descr_chain *chain = &card->rx_chain; 1147 struct spider_net_descr *descr; 1148 int i, status; 1149 1150 /* Advance tail pointer past any empty and reaped descrs */ 1151 descr = chain->tail; 1152 status = spider_net_get_descr_status(descr->hwdescr); 1153 1154 for (i=0; i<chain->num_desc; i++) { 1155 if ((status != SPIDER_NET_DESCR_CARDOWNED) && 1156 (status != SPIDER_NET_DESCR_NOT_IN_USE)) break; 1157 descr = descr->next; 1158 status = spider_net_get_descr_status(descr->hwdescr); 1159 } 1160 chain->tail = descr; 1161 1162 if ((i == chain->num_desc) || (i == 0)) 1163 return 1; 1164 return 0; 1165 } 1166 1167 /** 1168 * spider_net_decode_one_descr - processes an RX descriptor 1169 * @card: card structure 1170 * 1171 * Returns 1 if a packet has been sent to the stack, otherwise 0. 1172 * 1173 * Processes an RX descriptor by iommu-unmapping the data buffer 1174 * and passing the packet up to the stack. This function is called 1175 * in softirq context, e.g. either bottom half from interrupt or 1176 * NAPI polling context. 1177 */ 1178 static int 1179 spider_net_decode_one_descr(struct spider_net_card *card) 1180 { 1181 struct net_device *dev = card->netdev; 1182 struct spider_net_descr_chain *chain = &card->rx_chain; 1183 struct spider_net_descr *descr = chain->tail; 1184 struct spider_net_hw_descr *hwdescr = descr->hwdescr; 1185 u32 hw_buf_addr; 1186 int status; 1187 1188 status = spider_net_get_descr_status(hwdescr); 1189 1190 /* Nothing in the descriptor, or ring must be empty */ 1191 if ((status == SPIDER_NET_DESCR_CARDOWNED) || 1192 (status == SPIDER_NET_DESCR_NOT_IN_USE)) 1193 return 0; 1194 1195 /* descriptor definitively used -- move on tail */ 1196 chain->tail = descr->next; 1197 1198 /* unmap descriptor */ 1199 hw_buf_addr = hwdescr->buf_addr; 1200 hwdescr->buf_addr = 0xffffffff; 1201 pci_unmap_single(card->pdev, hw_buf_addr, 1202 SPIDER_NET_MAX_FRAME, PCI_DMA_FROMDEVICE); 1203 1204 if ( (status == SPIDER_NET_DESCR_RESPONSE_ERROR) || 1205 (status == SPIDER_NET_DESCR_PROTECTION_ERROR) || 1206 (status == SPIDER_NET_DESCR_FORCE_END) ) { 1207 if (netif_msg_rx_err(card)) 1208 dev_err(&dev->dev, 1209 "dropping RX descriptor with state %d\n", status); 1210 dev->stats.rx_dropped++; 1211 goto bad_desc; 1212 } 1213 1214 if ( (status != SPIDER_NET_DESCR_COMPLETE) && 1215 (status != SPIDER_NET_DESCR_FRAME_END) ) { 1216 if (netif_msg_rx_err(card)) 1217 dev_err(&card->netdev->dev, 1218 "RX descriptor with unknown state %d\n", status); 1219 card->spider_stats.rx_desc_unk_state++; 1220 goto bad_desc; 1221 } 1222 1223 /* The cases we'll throw away the packet immediately */ 1224 if (hwdescr->data_error & SPIDER_NET_DESTROY_RX_FLAGS) { 1225 if (netif_msg_rx_err(card)) 1226 dev_err(&card->netdev->dev, 1227 "error in received descriptor found, " 1228 "data_status=x%08x, data_error=x%08x\n", 1229 hwdescr->data_status, hwdescr->data_error); 1230 goto bad_desc; 1231 } 1232 1233 if (hwdescr->dmac_cmd_status & SPIDER_NET_DESCR_BAD_STATUS) { 1234 dev_err(&card->netdev->dev, "bad status, cmd_status=x%08x\n", 1235 hwdescr->dmac_cmd_status); 1236 pr_err("buf_addr=x%08x\n", hw_buf_addr); 1237 pr_err("buf_size=x%08x\n", hwdescr->buf_size); 1238 pr_err("next_descr_addr=x%08x\n", hwdescr->next_descr_addr); 1239 pr_err("result_size=x%08x\n", hwdescr->result_size); 1240 pr_err("valid_size=x%08x\n", hwdescr->valid_size); 1241 pr_err("data_status=x%08x\n", hwdescr->data_status); 1242 pr_err("data_error=x%08x\n", hwdescr->data_error); 1243 pr_err("which=%ld\n", descr - card->rx_chain.ring); 1244 1245 card->spider_stats.rx_desc_error++; 1246 goto bad_desc; 1247 } 1248 1249 /* Ok, we've got a packet in descr */ 1250 spider_net_pass_skb_up(descr, card); 1251 descr->skb = NULL; 1252 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE; 1253 return 1; 1254 1255 bad_desc: 1256 if (netif_msg_rx_err(card)) 1257 show_rx_chain(card); 1258 dev_kfree_skb_irq(descr->skb); 1259 descr->skb = NULL; 1260 hwdescr->dmac_cmd_status = SPIDER_NET_DESCR_NOT_IN_USE; 1261 return 0; 1262 } 1263 1264 /** 1265 * spider_net_poll - NAPI poll function called by the stack to return packets 1266 * @netdev: interface device structure 1267 * @budget: number of packets we can pass to the stack at most 1268 * 1269 * returns 0 if no more packets available to the driver/stack. Returns 1, 1270 * if the quota is exceeded, but the driver has still packets. 1271 * 1272 * spider_net_poll returns all packets from the rx descriptors to the stack 1273 * (using netif_receive_skb). If all/enough packets are up, the driver 1274 * reenables interrupts and returns 0. If not, 1 is returned. 1275 */ 1276 static int spider_net_poll(struct napi_struct *napi, int budget) 1277 { 1278 struct spider_net_card *card = container_of(napi, struct spider_net_card, napi); 1279 int packets_done = 0; 1280 1281 while (packets_done < budget) { 1282 if (!spider_net_decode_one_descr(card)) 1283 break; 1284 1285 packets_done++; 1286 } 1287 1288 if ((packets_done == 0) && (card->num_rx_ints != 0)) { 1289 if (!spider_net_resync_tail_ptr(card)) 1290 packets_done = budget; 1291 spider_net_resync_head_ptr(card); 1292 } 1293 card->num_rx_ints = 0; 1294 1295 spider_net_refill_rx_chain(card); 1296 spider_net_enable_rxdmac(card); 1297 1298 spider_net_cleanup_tx_ring(card); 1299 1300 /* if all packets are in the stack, enable interrupts and return 0 */ 1301 /* if not, return 1 */ 1302 if (packets_done < budget) { 1303 napi_complete(napi); 1304 spider_net_rx_irq_on(card); 1305 card->ignore_rx_ramfull = 0; 1306 } 1307 1308 return packets_done; 1309 } 1310 1311 /** 1312 * spider_net_change_mtu - changes the MTU of an interface 1313 * @netdev: interface device structure 1314 * @new_mtu: new MTU value 1315 * 1316 * returns 0 on success, <0 on failure 1317 */ 1318 static int 1319 spider_net_change_mtu(struct net_device *netdev, int new_mtu) 1320 { 1321 /* no need to re-alloc skbs or so -- the max mtu is about 2.3k 1322 * and mtu is outbound only anyway */ 1323 if ( (new_mtu < SPIDER_NET_MIN_MTU ) || 1324 (new_mtu > SPIDER_NET_MAX_MTU) ) 1325 return -EINVAL; 1326 netdev->mtu = new_mtu; 1327 return 0; 1328 } 1329 1330 /** 1331 * spider_net_set_mac - sets the MAC of an interface 1332 * @netdev: interface device structure 1333 * @ptr: pointer to new MAC address 1334 * 1335 * Returns 0 on success, <0 on failure. Currently, we don't support this 1336 * and will always return EOPNOTSUPP. 1337 */ 1338 static int 1339 spider_net_set_mac(struct net_device *netdev, void *p) 1340 { 1341 struct spider_net_card *card = netdev_priv(netdev); 1342 u32 macl, macu, regvalue; 1343 struct sockaddr *addr = p; 1344 1345 if (!is_valid_ether_addr(addr->sa_data)) 1346 return -EADDRNOTAVAIL; 1347 1348 /* switch off GMACTPE and GMACRPE */ 1349 regvalue = spider_net_read_reg(card, SPIDER_NET_GMACOPEMD); 1350 regvalue &= ~((1 << 5) | (1 << 6)); 1351 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD, regvalue); 1352 1353 /* write mac */ 1354 macu = (addr->sa_data[0]<<24) + (addr->sa_data[1]<<16) + 1355 (addr->sa_data[2]<<8) + (addr->sa_data[3]); 1356 macl = (addr->sa_data[4]<<8) + (addr->sa_data[5]); 1357 spider_net_write_reg(card, SPIDER_NET_GMACUNIMACU, macu); 1358 spider_net_write_reg(card, SPIDER_NET_GMACUNIMACL, macl); 1359 1360 /* switch GMACTPE and GMACRPE back on */ 1361 regvalue = spider_net_read_reg(card, SPIDER_NET_GMACOPEMD); 1362 regvalue |= ((1 << 5) | (1 << 6)); 1363 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD, regvalue); 1364 1365 spider_net_set_promisc(card); 1366 1367 /* look up, whether we have been successful */ 1368 if (spider_net_get_mac_address(netdev)) 1369 return -EADDRNOTAVAIL; 1370 if (memcmp(netdev->dev_addr,addr->sa_data,netdev->addr_len)) 1371 return -EADDRNOTAVAIL; 1372 1373 return 0; 1374 } 1375 1376 /** 1377 * spider_net_link_reset 1378 * @netdev: net device structure 1379 * 1380 * This is called when the PHY_LINK signal is asserted. For the blade this is 1381 * not connected so we should never get here. 1382 * 1383 */ 1384 static void 1385 spider_net_link_reset(struct net_device *netdev) 1386 { 1387 1388 struct spider_net_card *card = netdev_priv(netdev); 1389 1390 del_timer_sync(&card->aneg_timer); 1391 1392 /* clear interrupt, block further interrupts */ 1393 spider_net_write_reg(card, SPIDER_NET_GMACST, 1394 spider_net_read_reg(card, SPIDER_NET_GMACST)); 1395 spider_net_write_reg(card, SPIDER_NET_GMACINTEN, 0); 1396 1397 /* reset phy and setup aneg */ 1398 card->aneg_count = 0; 1399 card->medium = BCM54XX_COPPER; 1400 spider_net_setup_aneg(card); 1401 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER); 1402 1403 } 1404 1405 /** 1406 * spider_net_handle_error_irq - handles errors raised by an interrupt 1407 * @card: card structure 1408 * @status_reg: interrupt status register 0 (GHIINT0STS) 1409 * 1410 * spider_net_handle_error_irq treats or ignores all error conditions 1411 * found when an interrupt is presented 1412 */ 1413 static void 1414 spider_net_handle_error_irq(struct spider_net_card *card, u32 status_reg, 1415 u32 error_reg1, u32 error_reg2) 1416 { 1417 u32 i; 1418 int show_error = 1; 1419 1420 /* check GHIINT0STS ************************************/ 1421 if (status_reg) 1422 for (i = 0; i < 32; i++) 1423 if (status_reg & (1<<i)) 1424 switch (i) 1425 { 1426 /* let error_reg1 and error_reg2 evaluation decide, what to do 1427 case SPIDER_NET_PHYINT: 1428 case SPIDER_NET_GMAC2INT: 1429 case SPIDER_NET_GMAC1INT: 1430 case SPIDER_NET_GFIFOINT: 1431 case SPIDER_NET_DMACINT: 1432 case SPIDER_NET_GSYSINT: 1433 break; */ 1434 1435 case SPIDER_NET_GIPSINT: 1436 show_error = 0; 1437 break; 1438 1439 case SPIDER_NET_GPWOPCMPINT: 1440 /* PHY write operation completed */ 1441 show_error = 0; 1442 break; 1443 case SPIDER_NET_GPROPCMPINT: 1444 /* PHY read operation completed */ 1445 /* we don't use semaphores, as we poll for the completion 1446 * of the read operation in spider_net_read_phy. Should take 1447 * about 50 us */ 1448 show_error = 0; 1449 break; 1450 case SPIDER_NET_GPWFFINT: 1451 /* PHY command queue full */ 1452 if (netif_msg_intr(card)) 1453 dev_err(&card->netdev->dev, "PHY write queue full\n"); 1454 show_error = 0; 1455 break; 1456 1457 /* case SPIDER_NET_GRMDADRINT: not used. print a message */ 1458 /* case SPIDER_NET_GRMARPINT: not used. print a message */ 1459 /* case SPIDER_NET_GRMMPINT: not used. print a message */ 1460 1461 case SPIDER_NET_GDTDEN0INT: 1462 /* someone has set TX_DMA_EN to 0 */ 1463 show_error = 0; 1464 break; 1465 1466 case SPIDER_NET_GDDDEN0INT: /* fallthrough */ 1467 case SPIDER_NET_GDCDEN0INT: /* fallthrough */ 1468 case SPIDER_NET_GDBDEN0INT: /* fallthrough */ 1469 case SPIDER_NET_GDADEN0INT: 1470 /* someone has set RX_DMA_EN to 0 */ 1471 show_error = 0; 1472 break; 1473 1474 /* RX interrupts */ 1475 case SPIDER_NET_GDDFDCINT: 1476 case SPIDER_NET_GDCFDCINT: 1477 case SPIDER_NET_GDBFDCINT: 1478 case SPIDER_NET_GDAFDCINT: 1479 /* case SPIDER_NET_GDNMINT: not used. print a message */ 1480 /* case SPIDER_NET_GCNMINT: not used. print a message */ 1481 /* case SPIDER_NET_GBNMINT: not used. print a message */ 1482 /* case SPIDER_NET_GANMINT: not used. print a message */ 1483 /* case SPIDER_NET_GRFNMINT: not used. print a message */ 1484 show_error = 0; 1485 break; 1486 1487 /* TX interrupts */ 1488 case SPIDER_NET_GDTFDCINT: 1489 show_error = 0; 1490 break; 1491 case SPIDER_NET_GTTEDINT: 1492 show_error = 0; 1493 break; 1494 case SPIDER_NET_GDTDCEINT: 1495 /* chain end. If a descriptor should be sent, kick off 1496 * tx dma 1497 if (card->tx_chain.tail != card->tx_chain.head) 1498 spider_net_kick_tx_dma(card); 1499 */ 1500 show_error = 0; 1501 break; 1502 1503 /* case SPIDER_NET_G1TMCNTINT: not used. print a message */ 1504 /* case SPIDER_NET_GFREECNTINT: not used. print a message */ 1505 } 1506 1507 /* check GHIINT1STS ************************************/ 1508 if (error_reg1) 1509 for (i = 0; i < 32; i++) 1510 if (error_reg1 & (1<<i)) 1511 switch (i) 1512 { 1513 case SPIDER_NET_GTMFLLINT: 1514 /* TX RAM full may happen on a usual case. 1515 * Logging is not needed. */ 1516 show_error = 0; 1517 break; 1518 case SPIDER_NET_GRFDFLLINT: /* fallthrough */ 1519 case SPIDER_NET_GRFCFLLINT: /* fallthrough */ 1520 case SPIDER_NET_GRFBFLLINT: /* fallthrough */ 1521 case SPIDER_NET_GRFAFLLINT: /* fallthrough */ 1522 case SPIDER_NET_GRMFLLINT: 1523 /* Could happen when rx chain is full */ 1524 if (card->ignore_rx_ramfull == 0) { 1525 card->ignore_rx_ramfull = 1; 1526 spider_net_resync_head_ptr(card); 1527 spider_net_refill_rx_chain(card); 1528 spider_net_enable_rxdmac(card); 1529 card->num_rx_ints ++; 1530 napi_schedule(&card->napi); 1531 } 1532 show_error = 0; 1533 break; 1534 1535 /* case SPIDER_NET_GTMSHTINT: problem, print a message */ 1536 case SPIDER_NET_GDTINVDINT: 1537 /* allrighty. tx from previous descr ok */ 1538 show_error = 0; 1539 break; 1540 1541 /* chain end */ 1542 case SPIDER_NET_GDDDCEINT: /* fallthrough */ 1543 case SPIDER_NET_GDCDCEINT: /* fallthrough */ 1544 case SPIDER_NET_GDBDCEINT: /* fallthrough */ 1545 case SPIDER_NET_GDADCEINT: 1546 spider_net_resync_head_ptr(card); 1547 spider_net_refill_rx_chain(card); 1548 spider_net_enable_rxdmac(card); 1549 card->num_rx_ints ++; 1550 napi_schedule(&card->napi); 1551 show_error = 0; 1552 break; 1553 1554 /* invalid descriptor */ 1555 case SPIDER_NET_GDDINVDINT: /* fallthrough */ 1556 case SPIDER_NET_GDCINVDINT: /* fallthrough */ 1557 case SPIDER_NET_GDBINVDINT: /* fallthrough */ 1558 case SPIDER_NET_GDAINVDINT: 1559 /* Could happen when rx chain is full */ 1560 spider_net_resync_head_ptr(card); 1561 spider_net_refill_rx_chain(card); 1562 spider_net_enable_rxdmac(card); 1563 card->num_rx_ints ++; 1564 napi_schedule(&card->napi); 1565 show_error = 0; 1566 break; 1567 1568 /* case SPIDER_NET_GDTRSERINT: problem, print a message */ 1569 /* case SPIDER_NET_GDDRSERINT: problem, print a message */ 1570 /* case SPIDER_NET_GDCRSERINT: problem, print a message */ 1571 /* case SPIDER_NET_GDBRSERINT: problem, print a message */ 1572 /* case SPIDER_NET_GDARSERINT: problem, print a message */ 1573 /* case SPIDER_NET_GDSERINT: problem, print a message */ 1574 /* case SPIDER_NET_GDTPTERINT: problem, print a message */ 1575 /* case SPIDER_NET_GDDPTERINT: problem, print a message */ 1576 /* case SPIDER_NET_GDCPTERINT: problem, print a message */ 1577 /* case SPIDER_NET_GDBPTERINT: problem, print a message */ 1578 /* case SPIDER_NET_GDAPTERINT: problem, print a message */ 1579 default: 1580 show_error = 1; 1581 break; 1582 } 1583 1584 /* check GHIINT2STS ************************************/ 1585 if (error_reg2) 1586 for (i = 0; i < 32; i++) 1587 if (error_reg2 & (1<<i)) 1588 switch (i) 1589 { 1590 /* there is nothing we can (want to) do at this time. Log a 1591 * message, we can switch on and off the specific values later on 1592 case SPIDER_NET_GPROPERINT: 1593 case SPIDER_NET_GMCTCRSNGINT: 1594 case SPIDER_NET_GMCTLCOLINT: 1595 case SPIDER_NET_GMCTTMOTINT: 1596 case SPIDER_NET_GMCRCAERINT: 1597 case SPIDER_NET_GMCRCALERINT: 1598 case SPIDER_NET_GMCRALNERINT: 1599 case SPIDER_NET_GMCROVRINT: 1600 case SPIDER_NET_GMCRRNTINT: 1601 case SPIDER_NET_GMCRRXERINT: 1602 case SPIDER_NET_GTITCSERINT: 1603 case SPIDER_NET_GTIFMTERINT: 1604 case SPIDER_NET_GTIPKTRVKINT: 1605 case SPIDER_NET_GTISPINGINT: 1606 case SPIDER_NET_GTISADNGINT: 1607 case SPIDER_NET_GTISPDNGINT: 1608 case SPIDER_NET_GRIFMTERINT: 1609 case SPIDER_NET_GRIPKTRVKINT: 1610 case SPIDER_NET_GRISPINGINT: 1611 case SPIDER_NET_GRISADNGINT: 1612 case SPIDER_NET_GRISPDNGINT: 1613 break; 1614 */ 1615 default: 1616 break; 1617 } 1618 1619 if ((show_error) && (netif_msg_intr(card)) && net_ratelimit()) 1620 dev_err(&card->netdev->dev, "Error interrupt, GHIINT0STS = 0x%08x, " 1621 "GHIINT1STS = 0x%08x, GHIINT2STS = 0x%08x\n", 1622 status_reg, error_reg1, error_reg2); 1623 1624 /* clear interrupt sources */ 1625 spider_net_write_reg(card, SPIDER_NET_GHIINT1STS, error_reg1); 1626 spider_net_write_reg(card, SPIDER_NET_GHIINT2STS, error_reg2); 1627 } 1628 1629 /** 1630 * spider_net_interrupt - interrupt handler for spider_net 1631 * @irq: interrupt number 1632 * @ptr: pointer to net_device 1633 * 1634 * returns IRQ_HANDLED, if interrupt was for driver, or IRQ_NONE, if no 1635 * interrupt found raised by card. 1636 * 1637 * This is the interrupt handler, that turns off 1638 * interrupts for this device and makes the stack poll the driver 1639 */ 1640 static irqreturn_t 1641 spider_net_interrupt(int irq, void *ptr) 1642 { 1643 struct net_device *netdev = ptr; 1644 struct spider_net_card *card = netdev_priv(netdev); 1645 u32 status_reg, error_reg1, error_reg2; 1646 1647 status_reg = spider_net_read_reg(card, SPIDER_NET_GHIINT0STS); 1648 error_reg1 = spider_net_read_reg(card, SPIDER_NET_GHIINT1STS); 1649 error_reg2 = spider_net_read_reg(card, SPIDER_NET_GHIINT2STS); 1650 1651 if (!(status_reg & SPIDER_NET_INT0_MASK_VALUE) && 1652 !(error_reg1 & SPIDER_NET_INT1_MASK_VALUE) && 1653 !(error_reg2 & SPIDER_NET_INT2_MASK_VALUE)) 1654 return IRQ_NONE; 1655 1656 if (status_reg & SPIDER_NET_RXINT ) { 1657 spider_net_rx_irq_off(card); 1658 napi_schedule(&card->napi); 1659 card->num_rx_ints ++; 1660 } 1661 if (status_reg & SPIDER_NET_TXINT) 1662 napi_schedule(&card->napi); 1663 1664 if (status_reg & SPIDER_NET_LINKINT) 1665 spider_net_link_reset(netdev); 1666 1667 if (status_reg & SPIDER_NET_ERRINT ) 1668 spider_net_handle_error_irq(card, status_reg, 1669 error_reg1, error_reg2); 1670 1671 /* clear interrupt sources */ 1672 spider_net_write_reg(card, SPIDER_NET_GHIINT0STS, status_reg); 1673 1674 return IRQ_HANDLED; 1675 } 1676 1677 #ifdef CONFIG_NET_POLL_CONTROLLER 1678 /** 1679 * spider_net_poll_controller - artificial interrupt for netconsole etc. 1680 * @netdev: interface device structure 1681 * 1682 * see Documentation/networking/netconsole.txt 1683 */ 1684 static void 1685 spider_net_poll_controller(struct net_device *netdev) 1686 { 1687 disable_irq(netdev->irq); 1688 spider_net_interrupt(netdev->irq, netdev); 1689 enable_irq(netdev->irq); 1690 } 1691 #endif /* CONFIG_NET_POLL_CONTROLLER */ 1692 1693 /** 1694 * spider_net_enable_interrupts - enable interrupts 1695 * @card: card structure 1696 * 1697 * spider_net_enable_interrupt enables several interrupts 1698 */ 1699 static void 1700 spider_net_enable_interrupts(struct spider_net_card *card) 1701 { 1702 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, 1703 SPIDER_NET_INT0_MASK_VALUE); 1704 spider_net_write_reg(card, SPIDER_NET_GHIINT1MSK, 1705 SPIDER_NET_INT1_MASK_VALUE); 1706 spider_net_write_reg(card, SPIDER_NET_GHIINT2MSK, 1707 SPIDER_NET_INT2_MASK_VALUE); 1708 } 1709 1710 /** 1711 * spider_net_disable_interrupts - disable interrupts 1712 * @card: card structure 1713 * 1714 * spider_net_disable_interrupts disables all the interrupts 1715 */ 1716 static void 1717 spider_net_disable_interrupts(struct spider_net_card *card) 1718 { 1719 spider_net_write_reg(card, SPIDER_NET_GHIINT0MSK, 0); 1720 spider_net_write_reg(card, SPIDER_NET_GHIINT1MSK, 0); 1721 spider_net_write_reg(card, SPIDER_NET_GHIINT2MSK, 0); 1722 spider_net_write_reg(card, SPIDER_NET_GMACINTEN, 0); 1723 } 1724 1725 /** 1726 * spider_net_init_card - initializes the card 1727 * @card: card structure 1728 * 1729 * spider_net_init_card initializes the card so that other registers can 1730 * be used 1731 */ 1732 static void 1733 spider_net_init_card(struct spider_net_card *card) 1734 { 1735 spider_net_write_reg(card, SPIDER_NET_CKRCTRL, 1736 SPIDER_NET_CKRCTRL_STOP_VALUE); 1737 1738 spider_net_write_reg(card, SPIDER_NET_CKRCTRL, 1739 SPIDER_NET_CKRCTRL_RUN_VALUE); 1740 1741 /* trigger ETOMOD signal */ 1742 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD, 1743 spider_net_read_reg(card, SPIDER_NET_GMACOPEMD) | 0x4); 1744 1745 spider_net_disable_interrupts(card); 1746 } 1747 1748 /** 1749 * spider_net_enable_card - enables the card by setting all kinds of regs 1750 * @card: card structure 1751 * 1752 * spider_net_enable_card sets a lot of SMMIO registers to enable the device 1753 */ 1754 static void 1755 spider_net_enable_card(struct spider_net_card *card) 1756 { 1757 int i; 1758 /* the following array consists of (register),(value) pairs 1759 * that are set in this function. A register of 0 ends the list */ 1760 u32 regs[][2] = { 1761 { SPIDER_NET_GRESUMINTNUM, 0 }, 1762 { SPIDER_NET_GREINTNUM, 0 }, 1763 1764 /* set interrupt frame number registers */ 1765 /* clear the single DMA engine registers first */ 1766 { SPIDER_NET_GFAFRMNUM, SPIDER_NET_GFXFRAMES_VALUE }, 1767 { SPIDER_NET_GFBFRMNUM, SPIDER_NET_GFXFRAMES_VALUE }, 1768 { SPIDER_NET_GFCFRMNUM, SPIDER_NET_GFXFRAMES_VALUE }, 1769 { SPIDER_NET_GFDFRMNUM, SPIDER_NET_GFXFRAMES_VALUE }, 1770 /* then set, what we really need */ 1771 { SPIDER_NET_GFFRMNUM, SPIDER_NET_FRAMENUM_VALUE }, 1772 1773 /* timer counter registers and stuff */ 1774 { SPIDER_NET_GFREECNNUM, 0 }, 1775 { SPIDER_NET_GONETIMENUM, 0 }, 1776 { SPIDER_NET_GTOUTFRMNUM, 0 }, 1777 1778 /* RX mode setting */ 1779 { SPIDER_NET_GRXMDSET, SPIDER_NET_RXMODE_VALUE }, 1780 /* TX mode setting */ 1781 { SPIDER_NET_GTXMDSET, SPIDER_NET_TXMODE_VALUE }, 1782 /* IPSEC mode setting */ 1783 { SPIDER_NET_GIPSECINIT, SPIDER_NET_IPSECINIT_VALUE }, 1784 1785 { SPIDER_NET_GFTRESTRT, SPIDER_NET_RESTART_VALUE }, 1786 1787 { SPIDER_NET_GMRWOLCTRL, 0 }, 1788 { SPIDER_NET_GTESTMD, 0x10000000 }, 1789 { SPIDER_NET_GTTQMSK, 0x00400040 }, 1790 1791 { SPIDER_NET_GMACINTEN, 0 }, 1792 1793 /* flow control stuff */ 1794 { SPIDER_NET_GMACAPAUSE, SPIDER_NET_MACAPAUSE_VALUE }, 1795 { SPIDER_NET_GMACTXPAUSE, SPIDER_NET_TXPAUSE_VALUE }, 1796 1797 { SPIDER_NET_GMACBSTLMT, SPIDER_NET_BURSTLMT_VALUE }, 1798 { 0, 0} 1799 }; 1800 1801 i = 0; 1802 while (regs[i][0]) { 1803 spider_net_write_reg(card, regs[i][0], regs[i][1]); 1804 i++; 1805 } 1806 1807 /* clear unicast filter table entries 1 to 14 */ 1808 for (i = 1; i <= 14; i++) { 1809 spider_net_write_reg(card, 1810 SPIDER_NET_GMRUAFILnR + i * 8, 1811 0x00080000); 1812 spider_net_write_reg(card, 1813 SPIDER_NET_GMRUAFILnR + i * 8 + 4, 1814 0x00000000); 1815 } 1816 1817 spider_net_write_reg(card, SPIDER_NET_GMRUA0FIL15R, 0x08080000); 1818 1819 spider_net_write_reg(card, SPIDER_NET_ECMODE, SPIDER_NET_ECMODE_VALUE); 1820 1821 /* set chain tail address for RX chains and 1822 * enable DMA */ 1823 spider_net_enable_rxchtails(card); 1824 spider_net_enable_rxdmac(card); 1825 1826 spider_net_write_reg(card, SPIDER_NET_GRXDMAEN, SPIDER_NET_WOL_VALUE); 1827 1828 spider_net_write_reg(card, SPIDER_NET_GMACLENLMT, 1829 SPIDER_NET_LENLMT_VALUE); 1830 spider_net_write_reg(card, SPIDER_NET_GMACOPEMD, 1831 SPIDER_NET_OPMODE_VALUE); 1832 1833 spider_net_write_reg(card, SPIDER_NET_GDTDMACCNTR, 1834 SPIDER_NET_GDTBSTA); 1835 } 1836 1837 /** 1838 * spider_net_download_firmware - loads firmware into the adapter 1839 * @card: card structure 1840 * @firmware_ptr: pointer to firmware data 1841 * 1842 * spider_net_download_firmware loads the firmware data into the 1843 * adapter. It assumes the length etc. to be allright. 1844 */ 1845 static int 1846 spider_net_download_firmware(struct spider_net_card *card, 1847 const void *firmware_ptr) 1848 { 1849 int sequencer, i; 1850 const u32 *fw_ptr = firmware_ptr; 1851 1852 /* stop sequencers */ 1853 spider_net_write_reg(card, SPIDER_NET_GSINIT, 1854 SPIDER_NET_STOP_SEQ_VALUE); 1855 1856 for (sequencer = 0; sequencer < SPIDER_NET_FIRMWARE_SEQS; 1857 sequencer++) { 1858 spider_net_write_reg(card, 1859 SPIDER_NET_GSnPRGADR + sequencer * 8, 0); 1860 for (i = 0; i < SPIDER_NET_FIRMWARE_SEQWORDS; i++) { 1861 spider_net_write_reg(card, SPIDER_NET_GSnPRGDAT + 1862 sequencer * 8, *fw_ptr); 1863 fw_ptr++; 1864 } 1865 } 1866 1867 if (spider_net_read_reg(card, SPIDER_NET_GSINIT)) 1868 return -EIO; 1869 1870 spider_net_write_reg(card, SPIDER_NET_GSINIT, 1871 SPIDER_NET_RUN_SEQ_VALUE); 1872 1873 return 0; 1874 } 1875 1876 /** 1877 * spider_net_init_firmware - reads in firmware parts 1878 * @card: card structure 1879 * 1880 * Returns 0 on success, <0 on failure 1881 * 1882 * spider_net_init_firmware opens the sequencer firmware and does some basic 1883 * checks. This function opens and releases the firmware structure. A call 1884 * to download the firmware is performed before the release. 1885 * 1886 * Firmware format 1887 * =============== 1888 * spider_fw.bin is expected to be a file containing 6*1024*4 bytes, 4k being 1889 * the program for each sequencer. Use the command 1890 * tail -q -n +2 Seq_code1_0x088.txt Seq_code2_0x090.txt \ 1891 * Seq_code3_0x098.txt Seq_code4_0x0A0.txt Seq_code5_0x0A8.txt \ 1892 * Seq_code6_0x0B0.txt | xxd -r -p -c4 > spider_fw.bin 1893 * 1894 * to generate spider_fw.bin, if you have sequencer programs with something 1895 * like the following contents for each sequencer: 1896 * <ONE LINE COMMENT> 1897 * <FIRST 4-BYTES-WORD FOR SEQUENCER> 1898 * <SECOND 4-BYTES-WORD FOR SEQUENCER> 1899 * ... 1900 * <1024th 4-BYTES-WORD FOR SEQUENCER> 1901 */ 1902 static int 1903 spider_net_init_firmware(struct spider_net_card *card) 1904 { 1905 struct firmware *firmware = NULL; 1906 struct device_node *dn; 1907 const u8 *fw_prop = NULL; 1908 int err = -ENOENT; 1909 int fw_size; 1910 1911 if (request_firmware((const struct firmware **)&firmware, 1912 SPIDER_NET_FIRMWARE_NAME, &card->pdev->dev) == 0) { 1913 if ( (firmware->size != SPIDER_NET_FIRMWARE_LEN) && 1914 netif_msg_probe(card) ) { 1915 dev_err(&card->netdev->dev, 1916 "Incorrect size of spidernet firmware in " \ 1917 "filesystem. Looking in host firmware...\n"); 1918 goto try_host_fw; 1919 } 1920 err = spider_net_download_firmware(card, firmware->data); 1921 1922 release_firmware(firmware); 1923 if (err) 1924 goto try_host_fw; 1925 1926 goto done; 1927 } 1928 1929 try_host_fw: 1930 dn = pci_device_to_OF_node(card->pdev); 1931 if (!dn) 1932 goto out_err; 1933 1934 fw_prop = of_get_property(dn, "firmware", &fw_size); 1935 if (!fw_prop) 1936 goto out_err; 1937 1938 if ( (fw_size != SPIDER_NET_FIRMWARE_LEN) && 1939 netif_msg_probe(card) ) { 1940 dev_err(&card->netdev->dev, 1941 "Incorrect size of spidernet firmware in host firmware\n"); 1942 goto done; 1943 } 1944 1945 err = spider_net_download_firmware(card, fw_prop); 1946 1947 done: 1948 return err; 1949 out_err: 1950 if (netif_msg_probe(card)) 1951 dev_err(&card->netdev->dev, 1952 "Couldn't find spidernet firmware in filesystem " \ 1953 "or host firmware\n"); 1954 return err; 1955 } 1956 1957 /** 1958 * spider_net_open - called upon ifonfig up 1959 * @netdev: interface device structure 1960 * 1961 * returns 0 on success, <0 on failure 1962 * 1963 * spider_net_open allocates all the descriptors and memory needed for 1964 * operation, sets up multicast list and enables interrupts 1965 */ 1966 int 1967 spider_net_open(struct net_device *netdev) 1968 { 1969 struct spider_net_card *card = netdev_priv(netdev); 1970 int result; 1971 1972 result = spider_net_init_firmware(card); 1973 if (result) 1974 goto init_firmware_failed; 1975 1976 /* start probing with copper */ 1977 card->aneg_count = 0; 1978 card->medium = BCM54XX_COPPER; 1979 spider_net_setup_aneg(card); 1980 if (card->phy.def->phy_id) 1981 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER); 1982 1983 result = spider_net_init_chain(card, &card->tx_chain); 1984 if (result) 1985 goto alloc_tx_failed; 1986 card->low_watermark = NULL; 1987 1988 result = spider_net_init_chain(card, &card->rx_chain); 1989 if (result) 1990 goto alloc_rx_failed; 1991 1992 /* Allocate rx skbs */ 1993 result = spider_net_alloc_rx_skbs(card); 1994 if (result) 1995 goto alloc_skbs_failed; 1996 1997 spider_net_set_multi(netdev); 1998 1999 /* further enhancement: setup hw vlan, if needed */ 2000 2001 result = -EBUSY; 2002 if (request_irq(netdev->irq, spider_net_interrupt, 2003 IRQF_SHARED, netdev->name, netdev)) 2004 goto register_int_failed; 2005 2006 spider_net_enable_card(card); 2007 2008 netif_start_queue(netdev); 2009 netif_carrier_on(netdev); 2010 napi_enable(&card->napi); 2011 2012 spider_net_enable_interrupts(card); 2013 2014 return 0; 2015 2016 register_int_failed: 2017 spider_net_free_rx_chain_contents(card); 2018 alloc_skbs_failed: 2019 spider_net_free_chain(card, &card->rx_chain); 2020 alloc_rx_failed: 2021 spider_net_free_chain(card, &card->tx_chain); 2022 alloc_tx_failed: 2023 del_timer_sync(&card->aneg_timer); 2024 init_firmware_failed: 2025 return result; 2026 } 2027 2028 /** 2029 * spider_net_link_phy 2030 * @data: used for pointer to card structure 2031 * 2032 */ 2033 static void spider_net_link_phy(unsigned long data) 2034 { 2035 struct spider_net_card *card = (struct spider_net_card *)data; 2036 struct mii_phy *phy = &card->phy; 2037 2038 /* if link didn't come up after SPIDER_NET_ANEG_TIMEOUT tries, setup phy again */ 2039 if (card->aneg_count > SPIDER_NET_ANEG_TIMEOUT) { 2040 2041 pr_debug("%s: link is down trying to bring it up\n", 2042 card->netdev->name); 2043 2044 switch (card->medium) { 2045 case BCM54XX_COPPER: 2046 /* enable fiber with autonegotiation first */ 2047 if (phy->def->ops->enable_fiber) 2048 phy->def->ops->enable_fiber(phy, 1); 2049 card->medium = BCM54XX_FIBER; 2050 break; 2051 2052 case BCM54XX_FIBER: 2053 /* fiber didn't come up, try to disable fiber autoneg */ 2054 if (phy->def->ops->enable_fiber) 2055 phy->def->ops->enable_fiber(phy, 0); 2056 card->medium = BCM54XX_UNKNOWN; 2057 break; 2058 2059 case BCM54XX_UNKNOWN: 2060 /* copper, fiber with and without failed, 2061 * retry from beginning */ 2062 spider_net_setup_aneg(card); 2063 card->medium = BCM54XX_COPPER; 2064 break; 2065 } 2066 2067 card->aneg_count = 0; 2068 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER); 2069 return; 2070 } 2071 2072 /* link still not up, try again later */ 2073 if (!(phy->def->ops->poll_link(phy))) { 2074 card->aneg_count++; 2075 mod_timer(&card->aneg_timer, jiffies + SPIDER_NET_ANEG_TIMER); 2076 return; 2077 } 2078 2079 /* link came up, get abilities */ 2080 phy->def->ops->read_link(phy); 2081 2082 spider_net_write_reg(card, SPIDER_NET_GMACST, 2083 spider_net_read_reg(card, SPIDER_NET_GMACST)); 2084 spider_net_write_reg(card, SPIDER_NET_GMACINTEN, 0x4); 2085 2086 if (phy->speed == 1000) 2087 spider_net_write_reg(card, SPIDER_NET_GMACMODE, 0x00000001); 2088 else 2089 spider_net_write_reg(card, SPIDER_NET_GMACMODE, 0); 2090 2091 card->aneg_count = 0; 2092 2093 pr_info("%s: link up, %i Mbps, %s-duplex %sautoneg.\n", 2094 card->netdev->name, phy->speed, 2095 phy->duplex == 1 ? "Full" : "Half", 2096 phy->autoneg == 1 ? "" : "no "); 2097 } 2098 2099 /** 2100 * spider_net_setup_phy - setup PHY 2101 * @card: card structure 2102 * 2103 * returns 0 on success, <0 on failure 2104 * 2105 * spider_net_setup_phy is used as part of spider_net_probe. 2106 **/ 2107 static int 2108 spider_net_setup_phy(struct spider_net_card *card) 2109 { 2110 struct mii_phy *phy = &card->phy; 2111 2112 spider_net_write_reg(card, SPIDER_NET_GDTDMASEL, 2113 SPIDER_NET_DMASEL_VALUE); 2114 spider_net_write_reg(card, SPIDER_NET_GPCCTRL, 2115 SPIDER_NET_PHY_CTRL_VALUE); 2116 2117 phy->dev = card->netdev; 2118 phy->mdio_read = spider_net_read_phy; 2119 phy->mdio_write = spider_net_write_phy; 2120 2121 for (phy->mii_id = 1; phy->mii_id <= 31; phy->mii_id++) { 2122 unsigned short id; 2123 id = spider_net_read_phy(card->netdev, phy->mii_id, MII_BMSR); 2124 if (id != 0x0000 && id != 0xffff) { 2125 if (!sungem_phy_probe(phy, phy->mii_id)) { 2126 pr_info("Found %s.\n", phy->def->name); 2127 break; 2128 } 2129 } 2130 } 2131 2132 return 0; 2133 } 2134 2135 /** 2136 * spider_net_workaround_rxramfull - work around firmware bug 2137 * @card: card structure 2138 * 2139 * no return value 2140 **/ 2141 static void 2142 spider_net_workaround_rxramfull(struct spider_net_card *card) 2143 { 2144 int i, sequencer = 0; 2145 2146 /* cancel reset */ 2147 spider_net_write_reg(card, SPIDER_NET_CKRCTRL, 2148 SPIDER_NET_CKRCTRL_RUN_VALUE); 2149 2150 /* empty sequencer data */ 2151 for (sequencer = 0; sequencer < SPIDER_NET_FIRMWARE_SEQS; 2152 sequencer++) { 2153 spider_net_write_reg(card, SPIDER_NET_GSnPRGADR + 2154 sequencer * 8, 0x0); 2155 for (i = 0; i < SPIDER_NET_FIRMWARE_SEQWORDS; i++) { 2156 spider_net_write_reg(card, SPIDER_NET_GSnPRGDAT + 2157 sequencer * 8, 0x0); 2158 } 2159 } 2160 2161 /* set sequencer operation */ 2162 spider_net_write_reg(card, SPIDER_NET_GSINIT, 0x000000fe); 2163 2164 /* reset */ 2165 spider_net_write_reg(card, SPIDER_NET_CKRCTRL, 2166 SPIDER_NET_CKRCTRL_STOP_VALUE); 2167 } 2168 2169 /** 2170 * spider_net_stop - called upon ifconfig down 2171 * @netdev: interface device structure 2172 * 2173 * always returns 0 2174 */ 2175 int 2176 spider_net_stop(struct net_device *netdev) 2177 { 2178 struct spider_net_card *card = netdev_priv(netdev); 2179 2180 napi_disable(&card->napi); 2181 netif_carrier_off(netdev); 2182 netif_stop_queue(netdev); 2183 del_timer_sync(&card->tx_timer); 2184 del_timer_sync(&card->aneg_timer); 2185 2186 spider_net_disable_interrupts(card); 2187 2188 free_irq(netdev->irq, netdev); 2189 2190 spider_net_write_reg(card, SPIDER_NET_GDTDMACCNTR, 2191 SPIDER_NET_DMA_TX_FEND_VALUE); 2192 2193 /* turn off DMA, force end */ 2194 spider_net_disable_rxdmac(card); 2195 2196 /* release chains */ 2197 spider_net_release_tx_chain(card, 1); 2198 spider_net_free_rx_chain_contents(card); 2199 2200 spider_net_free_chain(card, &card->tx_chain); 2201 spider_net_free_chain(card, &card->rx_chain); 2202 2203 return 0; 2204 } 2205 2206 /** 2207 * spider_net_tx_timeout_task - task scheduled by the watchdog timeout 2208 * function (to be called not under interrupt status) 2209 * @data: data, is interface device structure 2210 * 2211 * called as task when tx hangs, resets interface (if interface is up) 2212 */ 2213 static void 2214 spider_net_tx_timeout_task(struct work_struct *work) 2215 { 2216 struct spider_net_card *card = 2217 container_of(work, struct spider_net_card, tx_timeout_task); 2218 struct net_device *netdev = card->netdev; 2219 2220 if (!(netdev->flags & IFF_UP)) 2221 goto out; 2222 2223 netif_device_detach(netdev); 2224 spider_net_stop(netdev); 2225 2226 spider_net_workaround_rxramfull(card); 2227 spider_net_init_card(card); 2228 2229 if (spider_net_setup_phy(card)) 2230 goto out; 2231 2232 spider_net_open(netdev); 2233 spider_net_kick_tx_dma(card); 2234 netif_device_attach(netdev); 2235 2236 out: 2237 atomic_dec(&card->tx_timeout_task_counter); 2238 } 2239 2240 /** 2241 * spider_net_tx_timeout - called when the tx timeout watchdog kicks in. 2242 * @netdev: interface device structure 2243 * 2244 * called, if tx hangs. Schedules a task that resets the interface 2245 */ 2246 static void 2247 spider_net_tx_timeout(struct net_device *netdev) 2248 { 2249 struct spider_net_card *card; 2250 2251 card = netdev_priv(netdev); 2252 atomic_inc(&card->tx_timeout_task_counter); 2253 if (netdev->flags & IFF_UP) 2254 schedule_work(&card->tx_timeout_task); 2255 else 2256 atomic_dec(&card->tx_timeout_task_counter); 2257 card->spider_stats.tx_timeouts++; 2258 } 2259 2260 static const struct net_device_ops spider_net_ops = { 2261 .ndo_open = spider_net_open, 2262 .ndo_stop = spider_net_stop, 2263 .ndo_start_xmit = spider_net_xmit, 2264 .ndo_set_rx_mode = spider_net_set_multi, 2265 .ndo_set_mac_address = spider_net_set_mac, 2266 .ndo_change_mtu = spider_net_change_mtu, 2267 .ndo_do_ioctl = spider_net_do_ioctl, 2268 .ndo_tx_timeout = spider_net_tx_timeout, 2269 .ndo_validate_addr = eth_validate_addr, 2270 /* HW VLAN */ 2271 #ifdef CONFIG_NET_POLL_CONTROLLER 2272 /* poll controller */ 2273 .ndo_poll_controller = spider_net_poll_controller, 2274 #endif /* CONFIG_NET_POLL_CONTROLLER */ 2275 }; 2276 2277 /** 2278 * spider_net_setup_netdev_ops - initialization of net_device operations 2279 * @netdev: net_device structure 2280 * 2281 * fills out function pointers in the net_device structure 2282 */ 2283 static void 2284 spider_net_setup_netdev_ops(struct net_device *netdev) 2285 { 2286 netdev->netdev_ops = &spider_net_ops; 2287 netdev->watchdog_timeo = SPIDER_NET_WATCHDOG_TIMEOUT; 2288 /* ethtool ops */ 2289 netdev->ethtool_ops = &spider_net_ethtool_ops; 2290 } 2291 2292 /** 2293 * spider_net_setup_netdev - initialization of net_device 2294 * @card: card structure 2295 * 2296 * Returns 0 on success or <0 on failure 2297 * 2298 * spider_net_setup_netdev initializes the net_device structure 2299 **/ 2300 static int 2301 spider_net_setup_netdev(struct spider_net_card *card) 2302 { 2303 int result; 2304 struct net_device *netdev = card->netdev; 2305 struct device_node *dn; 2306 struct sockaddr addr; 2307 const u8 *mac; 2308 2309 SET_NETDEV_DEV(netdev, &card->pdev->dev); 2310 2311 pci_set_drvdata(card->pdev, netdev); 2312 2313 init_timer(&card->tx_timer); 2314 card->tx_timer.function = 2315 (void (*)(unsigned long)) spider_net_cleanup_tx_ring; 2316 card->tx_timer.data = (unsigned long) card; 2317 netdev->irq = card->pdev->irq; 2318 2319 card->aneg_count = 0; 2320 init_timer(&card->aneg_timer); 2321 card->aneg_timer.function = spider_net_link_phy; 2322 card->aneg_timer.data = (unsigned long) card; 2323 2324 netif_napi_add(netdev, &card->napi, 2325 spider_net_poll, SPIDER_NET_NAPI_WEIGHT); 2326 2327 spider_net_setup_netdev_ops(netdev); 2328 2329 netdev->hw_features = NETIF_F_RXCSUM | NETIF_F_IP_CSUM; 2330 if (SPIDER_NET_RX_CSUM_DEFAULT) 2331 netdev->features |= NETIF_F_RXCSUM; 2332 netdev->features |= NETIF_F_IP_CSUM | NETIF_F_LLTX; 2333 /* some time: NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX | 2334 * NETIF_F_HW_VLAN_CTAG_FILTER */ 2335 2336 netdev->irq = card->pdev->irq; 2337 card->num_rx_ints = 0; 2338 card->ignore_rx_ramfull = 0; 2339 2340 dn = pci_device_to_OF_node(card->pdev); 2341 if (!dn) 2342 return -EIO; 2343 2344 mac = of_get_property(dn, "local-mac-address", NULL); 2345 if (!mac) 2346 return -EIO; 2347 memcpy(addr.sa_data, mac, ETH_ALEN); 2348 2349 result = spider_net_set_mac(netdev, &addr); 2350 if ((result) && (netif_msg_probe(card))) 2351 dev_err(&card->netdev->dev, 2352 "Failed to set MAC address: %i\n", result); 2353 2354 result = register_netdev(netdev); 2355 if (result) { 2356 if (netif_msg_probe(card)) 2357 dev_err(&card->netdev->dev, 2358 "Couldn't register net_device: %i\n", result); 2359 return result; 2360 } 2361 2362 if (netif_msg_probe(card)) 2363 pr_info("Initialized device %s.\n", netdev->name); 2364 2365 return 0; 2366 } 2367 2368 /** 2369 * spider_net_alloc_card - allocates net_device and card structure 2370 * 2371 * returns the card structure or NULL in case of errors 2372 * 2373 * the card and net_device structures are linked to each other 2374 */ 2375 static struct spider_net_card * 2376 spider_net_alloc_card(void) 2377 { 2378 struct net_device *netdev; 2379 struct spider_net_card *card; 2380 size_t alloc_size; 2381 2382 alloc_size = sizeof(struct spider_net_card) + 2383 (tx_descriptors + rx_descriptors) * sizeof(struct spider_net_descr); 2384 netdev = alloc_etherdev(alloc_size); 2385 if (!netdev) 2386 return NULL; 2387 2388 card = netdev_priv(netdev); 2389 card->netdev = netdev; 2390 card->msg_enable = SPIDER_NET_DEFAULT_MSG; 2391 INIT_WORK(&card->tx_timeout_task, spider_net_tx_timeout_task); 2392 init_waitqueue_head(&card->waitq); 2393 atomic_set(&card->tx_timeout_task_counter, 0); 2394 2395 card->rx_chain.num_desc = rx_descriptors; 2396 card->rx_chain.ring = card->darray; 2397 card->tx_chain.num_desc = tx_descriptors; 2398 card->tx_chain.ring = card->darray + rx_descriptors; 2399 2400 return card; 2401 } 2402 2403 /** 2404 * spider_net_undo_pci_setup - releases PCI ressources 2405 * @card: card structure 2406 * 2407 * spider_net_undo_pci_setup releases the mapped regions 2408 */ 2409 static void 2410 spider_net_undo_pci_setup(struct spider_net_card *card) 2411 { 2412 iounmap(card->regs); 2413 pci_release_regions(card->pdev); 2414 } 2415 2416 /** 2417 * spider_net_setup_pci_dev - sets up the device in terms of PCI operations 2418 * @pdev: PCI device 2419 * 2420 * Returns the card structure or NULL if any errors occur 2421 * 2422 * spider_net_setup_pci_dev initializes pdev and together with the 2423 * functions called in spider_net_open configures the device so that 2424 * data can be transferred over it 2425 * The net_device structure is attached to the card structure, if the 2426 * function returns without error. 2427 **/ 2428 static struct spider_net_card * 2429 spider_net_setup_pci_dev(struct pci_dev *pdev) 2430 { 2431 struct spider_net_card *card; 2432 unsigned long mmio_start, mmio_len; 2433 2434 if (pci_enable_device(pdev)) { 2435 dev_err(&pdev->dev, "Couldn't enable PCI device\n"); 2436 return NULL; 2437 } 2438 2439 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) { 2440 dev_err(&pdev->dev, 2441 "Couldn't find proper PCI device base address.\n"); 2442 goto out_disable_dev; 2443 } 2444 2445 if (pci_request_regions(pdev, spider_net_driver_name)) { 2446 dev_err(&pdev->dev, 2447 "Couldn't obtain PCI resources, aborting.\n"); 2448 goto out_disable_dev; 2449 } 2450 2451 pci_set_master(pdev); 2452 2453 card = spider_net_alloc_card(); 2454 if (!card) { 2455 dev_err(&pdev->dev, 2456 "Couldn't allocate net_device structure, aborting.\n"); 2457 goto out_release_regions; 2458 } 2459 card->pdev = pdev; 2460 2461 /* fetch base address and length of first resource */ 2462 mmio_start = pci_resource_start(pdev, 0); 2463 mmio_len = pci_resource_len(pdev, 0); 2464 2465 card->netdev->mem_start = mmio_start; 2466 card->netdev->mem_end = mmio_start + mmio_len; 2467 card->regs = ioremap(mmio_start, mmio_len); 2468 2469 if (!card->regs) { 2470 dev_err(&pdev->dev, 2471 "Couldn't obtain PCI resources, aborting.\n"); 2472 goto out_release_regions; 2473 } 2474 2475 return card; 2476 2477 out_release_regions: 2478 pci_release_regions(pdev); 2479 out_disable_dev: 2480 pci_disable_device(pdev); 2481 return NULL; 2482 } 2483 2484 /** 2485 * spider_net_probe - initialization of a device 2486 * @pdev: PCI device 2487 * @ent: entry in the device id list 2488 * 2489 * Returns 0 on success, <0 on failure 2490 * 2491 * spider_net_probe initializes pdev and registers a net_device 2492 * structure for it. After that, the device can be ifconfig'ed up 2493 **/ 2494 static int 2495 spider_net_probe(struct pci_dev *pdev, const struct pci_device_id *ent) 2496 { 2497 int err = -EIO; 2498 struct spider_net_card *card; 2499 2500 card = spider_net_setup_pci_dev(pdev); 2501 if (!card) 2502 goto out; 2503 2504 spider_net_workaround_rxramfull(card); 2505 spider_net_init_card(card); 2506 2507 err = spider_net_setup_phy(card); 2508 if (err) 2509 goto out_undo_pci; 2510 2511 err = spider_net_setup_netdev(card); 2512 if (err) 2513 goto out_undo_pci; 2514 2515 return 0; 2516 2517 out_undo_pci: 2518 spider_net_undo_pci_setup(card); 2519 free_netdev(card->netdev); 2520 out: 2521 return err; 2522 } 2523 2524 /** 2525 * spider_net_remove - removal of a device 2526 * @pdev: PCI device 2527 * 2528 * Returns 0 on success, <0 on failure 2529 * 2530 * spider_net_remove is called to remove the device and unregisters the 2531 * net_device 2532 **/ 2533 static void 2534 spider_net_remove(struct pci_dev *pdev) 2535 { 2536 struct net_device *netdev; 2537 struct spider_net_card *card; 2538 2539 netdev = pci_get_drvdata(pdev); 2540 card = netdev_priv(netdev); 2541 2542 wait_event(card->waitq, 2543 atomic_read(&card->tx_timeout_task_counter) == 0); 2544 2545 unregister_netdev(netdev); 2546 2547 /* switch off card */ 2548 spider_net_write_reg(card, SPIDER_NET_CKRCTRL, 2549 SPIDER_NET_CKRCTRL_STOP_VALUE); 2550 spider_net_write_reg(card, SPIDER_NET_CKRCTRL, 2551 SPIDER_NET_CKRCTRL_RUN_VALUE); 2552 2553 spider_net_undo_pci_setup(card); 2554 free_netdev(netdev); 2555 } 2556 2557 static struct pci_driver spider_net_driver = { 2558 .name = spider_net_driver_name, 2559 .id_table = spider_net_pci_tbl, 2560 .probe = spider_net_probe, 2561 .remove = spider_net_remove 2562 }; 2563 2564 /** 2565 * spider_net_init - init function when the driver is loaded 2566 * 2567 * spider_net_init registers the device driver 2568 */ 2569 static int __init spider_net_init(void) 2570 { 2571 printk(KERN_INFO "Spidernet version %s.\n", VERSION); 2572 2573 if (rx_descriptors < SPIDER_NET_RX_DESCRIPTORS_MIN) { 2574 rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_MIN; 2575 pr_info("adjusting rx descriptors to %i.\n", rx_descriptors); 2576 } 2577 if (rx_descriptors > SPIDER_NET_RX_DESCRIPTORS_MAX) { 2578 rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_MAX; 2579 pr_info("adjusting rx descriptors to %i.\n", rx_descriptors); 2580 } 2581 if (tx_descriptors < SPIDER_NET_TX_DESCRIPTORS_MIN) { 2582 tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_MIN; 2583 pr_info("adjusting tx descriptors to %i.\n", tx_descriptors); 2584 } 2585 if (tx_descriptors > SPIDER_NET_TX_DESCRIPTORS_MAX) { 2586 tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_MAX; 2587 pr_info("adjusting tx descriptors to %i.\n", tx_descriptors); 2588 } 2589 2590 return pci_register_driver(&spider_net_driver); 2591 } 2592 2593 /** 2594 * spider_net_cleanup - exit function when driver is unloaded 2595 * 2596 * spider_net_cleanup unregisters the device driver 2597 */ 2598 static void __exit spider_net_cleanup(void) 2599 { 2600 pci_unregister_driver(&spider_net_driver); 2601 } 2602 2603 module_init(spider_net_init); 2604 module_exit(spider_net_cleanup); 2605