1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
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
56MODULE_AUTHOR("Utz Bacher <utz.bacher@de.ibm.com> and Jens Osterkamp " \
57 "<Jens.Osterkamp@de.ibm.com>");
58MODULE_DESCRIPTION("Spider Southbridge Gigabit Ethernet driver");
59MODULE_LICENSE("GPL");
60MODULE_VERSION(VERSION);
61MODULE_FIRMWARE(SPIDER_NET_FIRMWARE_NAME);
62
63static int rx_descriptors = SPIDER_NET_RX_DESCRIPTORS_DEFAULT;
64static int tx_descriptors = SPIDER_NET_TX_DESCRIPTORS_DEFAULT;
65
66module_param(rx_descriptors, int, 0444);
67module_param(tx_descriptors, int, 0444);
68
69MODULE_PARM_DESC(rx_descriptors, "number of descriptors used " \
70 "in rx chains");
71MODULE_PARM_DESC(tx_descriptors, "number of descriptors used " \
72 "in tx chain");
73
74char spider_net_driver_name[] = "spidernet";
75
76static 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
82MODULE_DEVICE_TABLE(pci, spider_net_pci_tbl);
83
84
85
86
87
88
89
90
91static inline u32
92spider_net_read_reg(struct spider_net_card *card, u32 reg)
93{
94
95
96
97
98 return in_be32(card->regs + reg);
99}
100
101
102
103
104
105
106
107static inline void
108spider_net_write_reg(struct spider_net_card *card, u32 reg, u32 value)
109{
110
111
112
113
114 out_be32(card->regs + reg, value);
115}
116
117
118
119
120
121
122
123
124
125
126
127
128static void
129spider_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
143
144
145
146
147
148
149
150
151
152static int
153spider_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
162
163
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
175
176
177static void
178spider_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
208
209
210
211
212static void
213spider_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
223
224
225
226
227static void
228spider_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
238
239
240
241
242
243static void
244spider_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
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
271
272
273
274
275static int
276spider_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
299
300
301
302
303static inline int
304spider_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
311
312
313
314
315static void
316spider_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
334
335
336
337
338
339
340
341
342static int
343spider_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
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
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
388
389
390
391
392static void
393spider_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
412
413
414
415
416
417
418
419
420static int
421spider_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
430 bufsize = (SPIDER_NET_MAX_FRAME + SPIDER_NET_RXBUF_ALIGN - 1) &
431 (~(SPIDER_NET_RXBUF_ALIGN - 1));
432
433
434
435
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
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
477
478
479
480
481
482
483static inline void
484spider_net_enable_rxchtails(struct spider_net_card *card)
485{
486
487 spider_net_write_reg(card, SPIDER_NET_GDADCHA ,
488 card->rx_chain.tail->bus_addr);
489}
490
491
492
493
494
495
496
497
498static inline void
499spider_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
508
509
510
511
512
513static inline void
514spider_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
522
523
524
525
526static void
527spider_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
533
534
535
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
551
552
553
554
555static int
556spider_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
563 do {
564 descr->prev->hwdescr->next_descr_addr = descr->bus_addr;
565 descr = descr->next;
566 } while (descr != start);
567
568
569
570
571 if (spider_net_prepare_rx_descr(card, chain->head))
572 goto error;
573 else
574 chain->head = chain->head->next;
575
576
577
578 spider_net_refill_rx_chain(card);
579 spider_net_enable_rxdmac(card);
580 return 0;
581
582error:
583 spider_net_free_rx_chain_contents(card);
584 return -ENOMEM;
585}
586
587
588
589
590
591
592
593
594
595
596static u8
597spider_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
621
622
623
624
625
626
627static void
628spider_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
648
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
656write_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
677
678
679
680
681
682
683
684
685static int
686spider_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
735 wmb();
736 descr->prev->hwdescr->next_descr_addr = descr->bus_addr;
737
738 card->netdev->trans_start = jiffies;
739 return 0;
740}
741
742static int
743spider_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
753
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
763 if (cnt < card->tx_chain.num_desc/4)
764 return cnt;
765
766
767 descr = card->tx_chain.tail;
768 cnt = (cnt*3)/4;
769 for (i=0;i<cnt; i++)
770 descr = descr->next;
771
772
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
787
788
789
790
791
792
793
794
795
796
797static int
798spider_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
832
833
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
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
871
872
873
874
875
876
877
878
879
880static inline void
881spider_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
904out:
905 mod_timer(&card->tx_timer, jiffies + SPIDER_NET_TX_TIMER);
906}
907
908
909
910
911
912
913
914
915static int
916spider_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
937
938
939
940
941
942
943
944static void
945spider_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
956
957
958
959
960
961
962
963static int
964spider_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
974
975
976
977
978
979
980static void
981spider_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
993
994#define SPIDER_MISALIGN 2
995 skb_pull(skb, SPIDER_MISALIGN);
996 skb->protocol = eth_type_trans(skb, netdev);
997
998
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
1009 }
1010
1011
1012 netdev->stats.rx_packets++;
1013 netdev->stats.rx_bytes += skb->len;
1014
1015
1016 netif_receive_skb(skb);
1017}
1018
1019static 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
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
1109
1110
1111
1112
1113
1114
1115
1116static 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
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
1144static 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
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
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178static int
1179spider_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
1191 if ((status == SPIDER_NET_DESCR_CARDOWNED) ||
1192 (status == SPIDER_NET_DESCR_NOT_IN_USE))
1193 return 0;
1194
1195
1196 chain->tail = descr->next;
1197
1198
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
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
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
1255bad_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
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
1276static 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
1301
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
1313
1314
1315
1316
1317
1318static int
1319spider_net_change_mtu(struct net_device *netdev, int new_mtu)
1320{
1321
1322
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
1332
1333
1334
1335
1336
1337
1338static int
1339spider_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
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
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
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
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
1378
1379
1380
1381
1382
1383
1384static void
1385spider_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
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
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
1407
1408
1409
1410
1411
1412
1413static void
1414spider_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
1421 if (status_reg)
1422 for (i = 0; i < 32; i++)
1423 if (status_reg & (1<<i))
1424 switch (i)
1425 {
1426
1427
1428
1429
1430
1431
1432
1433
1434
1435 case SPIDER_NET_GIPSINT:
1436 show_error = 0;
1437 break;
1438
1439 case SPIDER_NET_GPWOPCMPINT:
1440
1441 show_error = 0;
1442 break;
1443 case SPIDER_NET_GPROPCMPINT:
1444
1445
1446
1447
1448 show_error = 0;
1449 break;
1450 case SPIDER_NET_GPWFFINT:
1451
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
1458
1459
1460
1461 case SPIDER_NET_GDTDEN0INT:
1462
1463 show_error = 0;
1464 break;
1465
1466 case SPIDER_NET_GDDDEN0INT:
1467 case SPIDER_NET_GDCDEN0INT:
1468 case SPIDER_NET_GDBDEN0INT:
1469 case SPIDER_NET_GDADEN0INT:
1470
1471 show_error = 0;
1472 break;
1473
1474
1475 case SPIDER_NET_GDDFDCINT:
1476 case SPIDER_NET_GDCFDCINT:
1477 case SPIDER_NET_GDBFDCINT:
1478 case SPIDER_NET_GDAFDCINT:
1479
1480
1481
1482
1483
1484 show_error = 0;
1485 break;
1486
1487
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
1496
1497
1498
1499
1500 show_error = 0;
1501 break;
1502
1503
1504
1505 }
1506
1507
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
1515
1516 show_error = 0;
1517 break;
1518 case SPIDER_NET_GRFDFLLINT:
1519 case SPIDER_NET_GRFCFLLINT:
1520 case SPIDER_NET_GRFBFLLINT:
1521 case SPIDER_NET_GRFAFLLINT:
1522 case SPIDER_NET_GRMFLLINT:
1523
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
1536 case SPIDER_NET_GDTINVDINT:
1537
1538 show_error = 0;
1539 break;
1540
1541
1542 case SPIDER_NET_GDDDCEINT:
1543 case SPIDER_NET_GDCDCEINT:
1544 case SPIDER_NET_GDBDCEINT:
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
1555 case SPIDER_NET_GDDINVDINT:
1556 case SPIDER_NET_GDCINVDINT:
1557 case SPIDER_NET_GDBINVDINT:
1558 case SPIDER_NET_GDAINVDINT:
1559
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
1569
1570
1571
1572
1573
1574
1575
1576
1577
1578
1579 default:
1580 show_error = 1;
1581 break;
1582 }
1583
1584
1585 if (error_reg2)
1586 for (i = 0; i < 32; i++)
1587 if (error_reg2 & (1<<i))
1588 switch (i)
1589 {
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
1602
1603
1604
1605
1606
1607
1608
1609
1610
1611
1612
1613
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
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
1631
1632
1633
1634
1635
1636
1637
1638
1639
1640static irqreturn_t
1641spider_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
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
1680
1681
1682
1683
1684static void
1685spider_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
1692
1693
1694
1695
1696
1697
1698
1699static void
1700spider_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
1712
1713
1714
1715
1716static void
1717spider_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
1727
1728
1729
1730
1731
1732static void
1733spider_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
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
1750
1751
1752
1753
1754static void
1755spider_net_enable_card(struct spider_net_card *card)
1756{
1757 int i;
1758
1759
1760 u32 regs[][2] = {
1761 { SPIDER_NET_GRESUMINTNUM, 0 },
1762 { SPIDER_NET_GREINTNUM, 0 },
1763
1764
1765
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
1771 { SPIDER_NET_GFFRMNUM, SPIDER_NET_FRAMENUM_VALUE },
1772
1773
1774 { SPIDER_NET_GFREECNNUM, 0 },
1775 { SPIDER_NET_GONETIMENUM, 0 },
1776 { SPIDER_NET_GTOUTFRMNUM, 0 },
1777
1778
1779 { SPIDER_NET_GRXMDSET, SPIDER_NET_RXMODE_VALUE },
1780
1781 { SPIDER_NET_GTXMDSET, SPIDER_NET_TXMODE_VALUE },
1782
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
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
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
1822
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
1839
1840
1841
1842
1843
1844
1845static int
1846spider_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
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
1878
1879
1880
1881
1882
1883
1884
1885
1886
1887
1888
1889
1890
1891
1892
1893
1894
1895
1896
1897
1898
1899
1900
1901
1902static int
1903spider_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
1929try_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
1947done:
1948 return err;
1949out_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
1959
1960
1961
1962
1963
1964
1965
1966int
1967spider_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
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
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
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
2016register_int_failed:
2017 spider_net_free_rx_chain_contents(card);
2018alloc_skbs_failed:
2019 spider_net_free_chain(card, &card->rx_chain);
2020alloc_rx_failed:
2021 spider_net_free_chain(card, &card->tx_chain);
2022alloc_tx_failed:
2023 del_timer_sync(&card->aneg_timer);
2024init_firmware_failed:
2025 return result;
2026}
2027
2028
2029
2030
2031
2032
2033static 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
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
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
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
2061
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
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
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
2101
2102
2103
2104
2105
2106
2107static int
2108spider_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
2137
2138
2139
2140
2141static void
2142spider_net_workaround_rxramfull(struct spider_net_card *card)
2143{
2144 int i, sequencer = 0;
2145
2146
2147 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
2148 SPIDER_NET_CKRCTRL_RUN_VALUE);
2149
2150
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
2162 spider_net_write_reg(card, SPIDER_NET_GSINIT, 0x000000fe);
2163
2164
2165 spider_net_write_reg(card, SPIDER_NET_CKRCTRL,
2166 SPIDER_NET_CKRCTRL_STOP_VALUE);
2167}
2168
2169
2170
2171
2172
2173
2174
2175int
2176spider_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
2194 spider_net_disable_rxdmac(card);
2195
2196
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
2208
2209
2210
2211
2212
2213static void
2214spider_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
2236out:
2237 atomic_dec(&card->tx_timeout_task_counter);
2238}
2239
2240
2241
2242
2243
2244
2245
2246static void
2247spider_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
2260static 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
2271#ifdef CONFIG_NET_POLL_CONTROLLER
2272
2273 .ndo_poll_controller = spider_net_poll_controller,
2274#endif
2275};
2276
2277
2278
2279
2280
2281
2282
2283static void
2284spider_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
2289 netdev->ethtool_ops = &spider_net_ethtool_ops;
2290}
2291
2292
2293
2294
2295
2296
2297
2298
2299
2300static int
2301spider_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
2334
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
2370
2371
2372
2373
2374
2375static struct spider_net_card *
2376spider_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
2405
2406
2407
2408
2409static void
2410spider_net_undo_pci_setup(struct spider_net_card *card)
2411{
2412 iounmap(card->regs);
2413 pci_release_regions(card->pdev);
2414}
2415
2416
2417
2418
2419
2420
2421
2422
2423
2424
2425
2426
2427
2428static struct spider_net_card *
2429spider_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
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
2477out_release_regions:
2478 pci_release_regions(pdev);
2479out_disable_dev:
2480 pci_disable_device(pdev);
2481 return NULL;
2482}
2483
2484
2485
2486
2487
2488
2489
2490
2491
2492
2493
2494static int
2495spider_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
2517out_undo_pci:
2518 spider_net_undo_pci_setup(card);
2519 free_netdev(card->netdev);
2520out:
2521 return err;
2522}
2523
2524
2525
2526
2527
2528
2529
2530
2531
2532
2533static void
2534spider_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
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
2557static 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
2566
2567
2568
2569static 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
2595
2596
2597
2598static void __exit spider_net_cleanup(void)
2599{
2600 pci_unregister_driver(&spider_net_driver);
2601}
2602
2603module_init(spider_net_init);
2604module_exit(spider_net_cleanup);
2605