aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/net/ps3_gelic_net.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/net/ps3_gelic_net.c')
-rw-r--r--drivers/net/ps3_gelic_net.c765
1 files changed, 471 insertions, 294 deletions
diff --git a/drivers/net/ps3_gelic_net.c b/drivers/net/ps3_gelic_net.c
index 3b11b1ca0e77..c9dd9c0ee22b 100644
--- a/drivers/net/ps3_gelic_net.c
+++ b/drivers/net/ps3_gelic_net.c
@@ -48,27 +48,22 @@
48#include "ps3_gelic_net.h" 48#include "ps3_gelic_net.h"
49 49
50#define DRV_NAME "Gelic Network Driver" 50#define DRV_NAME "Gelic Network Driver"
51#define DRV_VERSION "1.0" 51#define DRV_VERSION "1.1"
52 52
53MODULE_AUTHOR("SCE Inc."); 53MODULE_AUTHOR("SCE Inc.");
54MODULE_DESCRIPTION("Gelic Network driver"); 54MODULE_DESCRIPTION("Gelic Network driver");
55MODULE_LICENSE("GPL"); 55MODULE_LICENSE("GPL");
56 56
57static inline struct device *ctodev(struct gelic_card *card) 57
58{ 58static inline void gelic_card_enable_rxdmac(struct gelic_card *card);
59 return &card->dev->core; 59static inline void gelic_card_disable_rxdmac(struct gelic_card *card);
60} 60static inline void gelic_card_disable_txdmac(struct gelic_card *card);
61static inline u64 bus_id(struct gelic_card *card) 61static inline void gelic_card_reset_chain(struct gelic_card *card,
62{ 62 struct gelic_descr_chain *chain,
63 return card->dev->bus_id; 63 struct gelic_descr *start_descr);
64}
65static inline u64 dev_id(struct gelic_card *card)
66{
67 return card->dev->dev_id;
68}
69 64
70/* set irq_mask */ 65/* set irq_mask */
71static int gelic_card_set_irq_mask(struct gelic_card *card, u64 mask) 66int gelic_card_set_irq_mask(struct gelic_card *card, u64 mask)
72{ 67{
73 int status; 68 int status;
74 69
@@ -76,20 +71,23 @@ static int gelic_card_set_irq_mask(struct gelic_card *card, u64 mask)
76 mask, 0); 71 mask, 0);
77 if (status) 72 if (status)
78 dev_info(ctodev(card), 73 dev_info(ctodev(card),
79 "lv1_net_set_interrupt_mask failed %d\n", status); 74 "%s failed %d\n", __func__, status);
80 return status; 75 return status;
81} 76}
77
82static inline void gelic_card_rx_irq_on(struct gelic_card *card) 78static inline void gelic_card_rx_irq_on(struct gelic_card *card)
83{ 79{
84 gelic_card_set_irq_mask(card, card->ghiintmask | GELIC_CARD_RXINT); 80 card->irq_mask |= GELIC_CARD_RXINT;
81 gelic_card_set_irq_mask(card, card->irq_mask);
85} 82}
86static inline void gelic_card_rx_irq_off(struct gelic_card *card) 83static inline void gelic_card_rx_irq_off(struct gelic_card *card)
87{ 84{
88 gelic_card_set_irq_mask(card, card->ghiintmask & ~GELIC_CARD_RXINT); 85 card->irq_mask &= ~GELIC_CARD_RXINT;
86 gelic_card_set_irq_mask(card, card->irq_mask);
89} 87}
90 88
91static void 89static void gelic_card_get_ether_port_status(struct gelic_card *card,
92gelic_card_get_ether_port_status(struct gelic_card *card, int inform) 90 int inform)
93{ 91{
94 u64 v2; 92 u64 v2;
95 struct net_device *ether_netdev; 93 struct net_device *ether_netdev;
@@ -100,7 +98,7 @@ gelic_card_get_ether_port_status(struct gelic_card *card, int inform)
100 &card->ether_port_status, &v2); 98 &card->ether_port_status, &v2);
101 99
102 if (inform) { 100 if (inform) {
103 ether_netdev = card->netdev; 101 ether_netdev = card->netdev[GELIC_PORT_ETHERNET];
104 if (card->ether_port_status & GELIC_LV1_ETHER_LINK_UP) 102 if (card->ether_port_status & GELIC_LV1_ETHER_LINK_UP)
105 netif_carrier_on(ether_netdev); 103 netif_carrier_on(ether_netdev);
106 else 104 else
@@ -108,6 +106,48 @@ gelic_card_get_ether_port_status(struct gelic_card *card, int inform)
108 } 106 }
109} 107}
110 108
109void gelic_card_up(struct gelic_card *card)
110{
111 pr_debug("%s: called\n", __func__);
112 down(&card->updown_lock);
113 if (atomic_inc_return(&card->users) == 1) {
114 pr_debug("%s: real do\n", __func__);
115 /* enable irq */
116 gelic_card_set_irq_mask(card, card->irq_mask);
117 /* start rx */
118 gelic_card_enable_rxdmac(card);
119
120 napi_enable(&card->napi);
121 }
122 up(&card->updown_lock);
123 pr_debug("%s: done\n", __func__);
124}
125
126void gelic_card_down(struct gelic_card *card)
127{
128 u64 mask;
129 pr_debug("%s: called\n", __func__);
130 down(&card->updown_lock);
131 if (atomic_dec_if_positive(&card->users) == 0) {
132 pr_debug("%s: real do\n", __func__);
133 napi_disable(&card->napi);
134 /*
135 * Disable irq. Wireless interrupts will
136 * be disabled later if any
137 */
138 mask = card->irq_mask & (GELIC_CARD_WLAN_EVENT_RECEIVED |
139 GELIC_CARD_WLAN_COMMAND_COMPLETED);
140 gelic_card_set_irq_mask(card, mask);
141 /* stop rx */
142 gelic_card_disable_rxdmac(card);
143 gelic_card_reset_chain(card, &card->rx_chain,
144 card->descr + GELIC_NET_TX_DESCRIPTORS);
145 /* stop tx */
146 gelic_card_disable_txdmac(card);
147 }
148 up(&card->updown_lock);
149 pr_debug("%s: done\n", __func__);
150}
111 151
112/** 152/**
113 * gelic_descr_get_status -- returns the status of a descriptor 153 * gelic_descr_get_status -- returns the status of a descriptor
@@ -133,8 +173,8 @@ static void gelic_descr_set_status(struct gelic_descr *descr,
133 enum gelic_descr_dma_status status) 173 enum gelic_descr_dma_status status)
134{ 174{
135 descr->dmac_cmd_status = cpu_to_be32(status | 175 descr->dmac_cmd_status = cpu_to_be32(status |
136 (be32_to_cpu(descr->dmac_cmd_status) & 176 (be32_to_cpu(descr->dmac_cmd_status) &
137 ~GELIC_DESCR_DMA_STAT_MASK)); 177 ~GELIC_DESCR_DMA_STAT_MASK));
138 /* 178 /*
139 * dma_cmd_status field is used to indicate whether the descriptor 179 * dma_cmd_status field is used to indicate whether the descriptor
140 * is valid or not. 180 * is valid or not.
@@ -225,6 +265,31 @@ iommu_error:
225} 265}
226 266
227/** 267/**
268 * gelic_card_reset_chain - reset status of a descriptor chain
269 * @card: card structure
270 * @chain: address of chain
271 * @start_descr: address of descriptor array
272 *
273 * Reset the status of dma descriptors to ready state
274 * and re-initialize the hardware chain for later use
275 */
276static void gelic_card_reset_chain(struct gelic_card *card,
277 struct gelic_descr_chain *chain,
278 struct gelic_descr *start_descr)
279{
280 struct gelic_descr *descr;
281
282 for (descr = start_descr; start_descr != descr->next; descr++) {
283 gelic_descr_set_status(descr, GELIC_DESCR_DMA_CARDOWNED);
284 descr->next_descr_addr = cpu_to_be32(descr->next->bus_addr);
285 }
286
287 chain->head = start_descr;
288 chain->tail = (descr - 1);
289
290 (descr - 1)->next_descr_addr = 0;
291}
292/**
228 * gelic_descr_prepare_rx - reinitializes a rx descriptor 293 * gelic_descr_prepare_rx - reinitializes a rx descriptor
229 * @card: card structure 294 * @card: card structure
230 * @descr: descriptor to re-init 295 * @descr: descriptor to re-init
@@ -235,21 +300,19 @@ iommu_error:
235 * Activate the descriptor state-wise 300 * Activate the descriptor state-wise
236 */ 301 */
237static int gelic_descr_prepare_rx(struct gelic_card *card, 302static int gelic_descr_prepare_rx(struct gelic_card *card,
238 struct gelic_descr *descr) 303 struct gelic_descr *descr)
239{ 304{
240 int offset; 305 int offset;
241 unsigned int bufsize; 306 unsigned int bufsize;
242 307
243 if (gelic_descr_get_status(descr) != GELIC_DESCR_DMA_NOT_IN_USE) 308 if (gelic_descr_get_status(descr) != GELIC_DESCR_DMA_NOT_IN_USE)
244 dev_info(ctodev(card), "%s: ERROR status \n", __func__); 309 dev_info(ctodev(card), "%s: ERROR status \n", __func__);
245
246 /* we need to round up the buffer size to a multiple of 128 */ 310 /* we need to round up the buffer size to a multiple of 128 */
247 bufsize = ALIGN(GELIC_NET_MAX_MTU, GELIC_NET_RXBUF_ALIGN); 311 bufsize = ALIGN(GELIC_NET_MAX_MTU, GELIC_NET_RXBUF_ALIGN);
248 312
249 /* and we need to have it 128 byte aligned, therefore we allocate a 313 /* and we need to have it 128 byte aligned, therefore we allocate a
250 * bit more */ 314 * bit more */
251 descr->skb = netdev_alloc_skb(card->netdev, 315 descr->skb = dev_alloc_skb(bufsize + GELIC_NET_RXBUF_ALIGN - 1);
252 bufsize + GELIC_NET_RXBUF_ALIGN - 1);
253 if (!descr->skb) { 316 if (!descr->skb) {
254 descr->buf_addr = 0; /* tell DMAC don't touch memory */ 317 descr->buf_addr = 0; /* tell DMAC don't touch memory */
255 dev_info(ctodev(card), 318 dev_info(ctodev(card),
@@ -349,7 +412,7 @@ static int gelic_card_alloc_rx_skbs(struct gelic_card *card)
349 int ret; 412 int ret;
350 chain = &card->rx_chain; 413 chain = &card->rx_chain;
351 ret = gelic_card_fill_rx_chain(card); 414 ret = gelic_card_fill_rx_chain(card);
352 chain->head = card->rx_top->prev; /* point to the last */ 415 chain->tail = card->rx_top->prev; /* point to the last */
353 return ret; 416 return ret;
354} 417}
355 418
@@ -361,16 +424,14 @@ static int gelic_card_alloc_rx_skbs(struct gelic_card *card)
361 * releases a used tx descriptor (unmapping, freeing of skb) 424 * releases a used tx descriptor (unmapping, freeing of skb)
362 */ 425 */
363static void gelic_descr_release_tx(struct gelic_card *card, 426static void gelic_descr_release_tx(struct gelic_card *card,
364 struct gelic_descr *descr) 427 struct gelic_descr *descr)
365{ 428{
366 struct sk_buff *skb = descr->skb; 429 struct sk_buff *skb = descr->skb;
367 430
368#ifdef DEBUG 431 BUG_ON(!(be32_to_cpu(descr->data_status) & GELIC_DESCR_TX_TAIL));
369 BUG_ON(!(be32_to_cpu(descr->data_status) & 432
370 (1 << GELIC_DESCR_TX_DMA_FRAME_TAIL))); 433 dma_unmap_single(ctodev(card), be32_to_cpu(descr->buf_addr), skb->len,
371#endif 434 DMA_TO_DEVICE);
372 dma_unmap_single(ctodev(card),
373 be32_to_cpu(descr->buf_addr), skb->len, DMA_TO_DEVICE);
374 dev_kfree_skb_any(skb); 435 dev_kfree_skb_any(skb);
375 436
376 descr->buf_addr = 0; 437 descr->buf_addr = 0;
@@ -386,6 +447,20 @@ static void gelic_descr_release_tx(struct gelic_card *card,
386 gelic_descr_set_status(descr, GELIC_DESCR_DMA_NOT_IN_USE); 447 gelic_descr_set_status(descr, GELIC_DESCR_DMA_NOT_IN_USE);
387} 448}
388 449
450static void gelic_card_stop_queues(struct gelic_card *card)
451{
452 netif_stop_queue(card->netdev[GELIC_PORT_ETHERNET]);
453
454 if (card->netdev[GELIC_PORT_WIRELESS])
455 netif_stop_queue(card->netdev[GELIC_PORT_WIRELESS]);
456}
457static void gelic_card_wake_queues(struct gelic_card *card)
458{
459 netif_wake_queue(card->netdev[GELIC_PORT_ETHERNET]);
460
461 if (card->netdev[GELIC_PORT_WIRELESS])
462 netif_wake_queue(card->netdev[GELIC_PORT_WIRELESS]);
463}
389/** 464/**
390 * gelic_card_release_tx_chain - processes sent tx descriptors 465 * gelic_card_release_tx_chain - processes sent tx descriptors
391 * @card: adapter structure 466 * @card: adapter structure
@@ -397,12 +472,14 @@ static void gelic_card_release_tx_chain(struct gelic_card *card, int stop)
397{ 472{
398 struct gelic_descr_chain *tx_chain; 473 struct gelic_descr_chain *tx_chain;
399 enum gelic_descr_dma_status status; 474 enum gelic_descr_dma_status status;
475 struct net_device *netdev;
400 int release = 0; 476 int release = 0;
401 477
402 for (tx_chain = &card->tx_chain; 478 for (tx_chain = &card->tx_chain;
403 tx_chain->head != tx_chain->tail && tx_chain->tail; 479 tx_chain->head != tx_chain->tail && tx_chain->tail;
404 tx_chain->tail = tx_chain->tail->next) { 480 tx_chain->tail = tx_chain->tail->next) {
405 status = gelic_descr_get_status(tx_chain->tail); 481 status = gelic_descr_get_status(tx_chain->tail);
482 netdev = tx_chain->tail->skb->dev;
406 switch (status) { 483 switch (status) {
407 case GELIC_DESCR_DMA_RESPONSE_ERROR: 484 case GELIC_DESCR_DMA_RESPONSE_ERROR:
408 case GELIC_DESCR_DMA_PROTECTION_ERROR: 485 case GELIC_DESCR_DMA_PROTECTION_ERROR:
@@ -412,13 +489,13 @@ static void gelic_card_release_tx_chain(struct gelic_card *card, int stop)
412 "%s: forcing end of tx descriptor " \ 489 "%s: forcing end of tx descriptor " \
413 "with status %x\n", 490 "with status %x\n",
414 __func__, status); 491 __func__, status);
415 card->netdev->stats.tx_dropped++; 492 netdev->stats.tx_dropped++;
416 break; 493 break;
417 494
418 case GELIC_DESCR_DMA_COMPLETE: 495 case GELIC_DESCR_DMA_COMPLETE:
419 if (tx_chain->tail->skb) { 496 if (tx_chain->tail->skb) {
420 card->netdev->stats.tx_packets++; 497 netdev->stats.tx_packets++;
421 card->netdev->stats.tx_bytes += 498 netdev->stats.tx_bytes +=
422 tx_chain->tail->skb->len; 499 tx_chain->tail->skb->len;
423 } 500 }
424 break; 501 break;
@@ -435,7 +512,7 @@ static void gelic_card_release_tx_chain(struct gelic_card *card, int stop)
435 } 512 }
436out: 513out:
437 if (!stop && release) 514 if (!stop && release)
438 netif_wake_queue(card->netdev); 515 gelic_card_wake_queues(card);
439} 516}
440 517
441/** 518/**
@@ -446,9 +523,9 @@ out:
446 * netdev interface. It also sets up multicast, allmulti and promisc 523 * netdev interface. It also sets up multicast, allmulti and promisc
447 * flags appropriately 524 * flags appropriately
448 */ 525 */
449static void gelic_net_set_multi(struct net_device *netdev) 526void gelic_net_set_multi(struct net_device *netdev)
450{ 527{
451 struct gelic_card *card = netdev_priv(netdev); 528 struct gelic_card *card = netdev_card(netdev);
452 struct dev_mc_list *mc; 529 struct dev_mc_list *mc;
453 unsigned int i; 530 unsigned int i;
454 uint8_t *p; 531 uint8_t *p;
@@ -470,8 +547,8 @@ static void gelic_net_set_multi(struct net_device *netdev)
470 "lv1_net_add_multicast_address failed, %d\n", 547 "lv1_net_add_multicast_address failed, %d\n",
471 status); 548 status);
472 549
473 if (netdev->flags & IFF_ALLMULTI 550 if ((netdev->flags & IFF_ALLMULTI) ||
474 || netdev->mc_count > GELIC_NET_MC_COUNT_MAX) { /* list max */ 551 (netdev->mc_count > GELIC_NET_MC_COUNT_MAX)) {
475 status = lv1_net_add_multicast_address(bus_id(card), 552 status = lv1_net_add_multicast_address(bus_id(card),
476 dev_id(card), 553 dev_id(card),
477 0, 1); 554 0, 1);
@@ -482,7 +559,7 @@ static void gelic_net_set_multi(struct net_device *netdev)
482 return; 559 return;
483 } 560 }
484 561
485 /* set multicast address */ 562 /* set multicast addresses */
486 for (mc = netdev->mc_list; mc; mc = mc->next) { 563 for (mc = netdev->mc_list; mc; mc = mc->next) {
487 addr = 0; 564 addr = 0;
488 p = mc->dmi_addr; 565 p = mc->dmi_addr;
@@ -511,8 +588,19 @@ static inline void gelic_card_enable_rxdmac(struct gelic_card *card)
511{ 588{
512 int status; 589 int status;
513 590
591#ifdef DEBUG
592 if (gelic_descr_get_status(card->rx_chain.head) !=
593 GELIC_DESCR_DMA_CARDOWNED) {
594 printk(KERN_ERR "%s: status=%x\n", __func__,
595 be32_to_cpu(card->rx_chain.head->dmac_cmd_status));
596 printk(KERN_ERR "%s: nextphy=%x\n", __func__,
597 be32_to_cpu(card->rx_chain.head->next_descr_addr));
598 printk(KERN_ERR "%s: head=%p\n", __func__,
599 card->rx_chain.head);
600 }
601#endif
514 status = lv1_net_start_rx_dma(bus_id(card), dev_id(card), 602 status = lv1_net_start_rx_dma(bus_id(card), dev_id(card),
515 card->rx_chain.tail->bus_addr, 0); 603 card->rx_chain.head->bus_addr, 0);
516 if (status) 604 if (status)
517 dev_info(ctodev(card), 605 dev_info(ctodev(card),
518 "lv1_net_start_rx_dma failed, status=%d\n", status); 606 "lv1_net_start_rx_dma failed, status=%d\n", status);
@@ -560,33 +648,19 @@ static inline void gelic_card_disable_txdmac(struct gelic_card *card)
560 * 648 *
561 * always returns 0 649 * always returns 0
562 */ 650 */
563static int gelic_net_stop(struct net_device *netdev) 651int gelic_net_stop(struct net_device *netdev)
564{ 652{
565 struct gelic_card *card = netdev_priv(netdev); 653 struct gelic_card *card;
566
567 napi_disable(&card->napi);
568 netif_stop_queue(netdev);
569
570 /* turn off DMA, force end */
571 gelic_card_disable_rxdmac(card);
572 gelic_card_disable_txdmac(card);
573
574 gelic_card_set_irq_mask(card, 0);
575 654
576 /* disconnect event port */ 655 pr_debug("%s: start\n", __func__);
577 free_irq(card->netdev->irq, card->netdev);
578 ps3_sb_event_receive_port_destroy(card->dev, card->netdev->irq);
579 card->netdev->irq = NO_IRQ;
580 656
657 netif_stop_queue(netdev);
581 netif_carrier_off(netdev); 658 netif_carrier_off(netdev);
582 659
583 /* release chains */ 660 card = netdev_card(netdev);
584 gelic_card_release_tx_chain(card, 1); 661 gelic_card_down(card);
585 gelic_card_release_rx_chain(card);
586
587 gelic_card_free_chain(card, card->tx_top);
588 gelic_card_free_chain(card, card->rx_top);
589 662
663 pr_debug("%s: done\n", __func__);
590 return 0; 664 return 0;
591} 665}
592 666
@@ -612,7 +686,7 @@ gelic_card_get_next_tx_descr(struct gelic_card *card)
612} 686}
613 687
614/** 688/**
615 * gelic_descr_set_tx_cmdstat - sets the tx descriptor command field 689 * gelic_net_set_txdescr_cmdstat - sets the tx descriptor command field
616 * @descr: descriptor structure to fill out 690 * @descr: descriptor structure to fill out
617 * @skb: packet to consider 691 * @skb: packet to consider
618 * 692 *
@@ -677,7 +751,7 @@ static inline struct sk_buff *gelic_put_vlan_tag(struct sk_buff *skb,
677} 751}
678 752
679/** 753/**
680 * gelic_descr_prepare_tx - get dma address of skb_data 754 * gelic_descr_prepare_tx - setup a descriptor for sending packets
681 * @card: card structure 755 * @card: card structure
682 * @descr: descriptor structure 756 * @descr: descriptor structure
683 * @skb: packet to use 757 * @skb: packet to use
@@ -691,10 +765,13 @@ static int gelic_descr_prepare_tx(struct gelic_card *card,
691{ 765{
692 dma_addr_t buf; 766 dma_addr_t buf;
693 767
694 if (card->vlan_index != -1) { 768 if (card->vlan_required) {
695 struct sk_buff *skb_tmp; 769 struct sk_buff *skb_tmp;
770 enum gelic_port_type type;
771
772 type = netdev_port(skb->dev)->type;
696 skb_tmp = gelic_put_vlan_tag(skb, 773 skb_tmp = gelic_put_vlan_tag(skb,
697 card->vlan_id[card->vlan_index]); 774 card->vlan[type].tx);
698 if (!skb_tmp) 775 if (!skb_tmp)
699 return -ENOMEM; 776 return -ENOMEM;
700 skb = skb_tmp; 777 skb = skb_tmp;
@@ -753,14 +830,14 @@ static int gelic_card_kick_txdma(struct gelic_card *card,
753 * 830 *
754 * returns 0 on success, <0 on failure 831 * returns 0 on success, <0 on failure
755 */ 832 */
756static int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev) 833int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev)
757{ 834{
758 struct gelic_card *card = netdev_priv(netdev); 835 struct gelic_card *card = netdev_card(netdev);
759 struct gelic_descr *descr; 836 struct gelic_descr *descr;
760 int result; 837 int result;
761 unsigned long flags; 838 unsigned long flags;
762 839
763 spin_lock_irqsave(&card->tx_dma_lock, flags); 840 spin_lock_irqsave(&card->tx_lock, flags);
764 841
765 gelic_card_release_tx_chain(card, 0); 842 gelic_card_release_tx_chain(card, 0);
766 843
@@ -769,8 +846,8 @@ static int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev)
769 /* 846 /*
770 * no more descriptors free 847 * no more descriptors free
771 */ 848 */
772 netif_stop_queue(netdev); 849 gelic_card_stop_queues(card);
773 spin_unlock_irqrestore(&card->tx_dma_lock, flags); 850 spin_unlock_irqrestore(&card->tx_lock, flags);
774 return NETDEV_TX_BUSY; 851 return NETDEV_TX_BUSY;
775 } 852 }
776 853
@@ -780,9 +857,9 @@ static int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev)
780 * DMA map failed. As chanses are that failure 857 * DMA map failed. As chanses are that failure
781 * would continue, just release skb and return 858 * would continue, just release skb and return
782 */ 859 */
783 card->netdev->stats.tx_dropped++; 860 netdev->stats.tx_dropped++;
784 dev_kfree_skb_any(skb); 861 dev_kfree_skb_any(skb);
785 spin_unlock_irqrestore(&card->tx_dma_lock, flags); 862 spin_unlock_irqrestore(&card->tx_lock, flags);
786 return NETDEV_TX_OK; 863 return NETDEV_TX_OK;
787 } 864 }
788 /* 865 /*
@@ -800,7 +877,7 @@ static int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev)
800 * kick failed. 877 * kick failed.
801 * release descriptors which were just prepared 878 * release descriptors which were just prepared
802 */ 879 */
803 card->netdev->stats.tx_dropped++; 880 netdev->stats.tx_dropped++;
804 gelic_descr_release_tx(card, descr); 881 gelic_descr_release_tx(card, descr);
805 gelic_descr_release_tx(card, descr->next); 882 gelic_descr_release_tx(card, descr->next);
806 card->tx_chain.tail = descr->next->next; 883 card->tx_chain.tail = descr->next->next;
@@ -810,7 +887,7 @@ static int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev)
810 netdev->trans_start = jiffies; 887 netdev->trans_start = jiffies;
811 } 888 }
812 889
813 spin_unlock_irqrestore(&card->tx_dma_lock, flags); 890 spin_unlock_irqrestore(&card->tx_lock, flags);
814 return NETDEV_TX_OK; 891 return NETDEV_TX_OK;
815} 892}
816 893
@@ -818,27 +895,27 @@ static int gelic_net_xmit(struct sk_buff *skb, struct net_device *netdev)
818 * gelic_net_pass_skb_up - takes an skb from a descriptor and passes it on 895 * gelic_net_pass_skb_up - takes an skb from a descriptor and passes it on
819 * @descr: descriptor to process 896 * @descr: descriptor to process
820 * @card: card structure 897 * @card: card structure
898 * @netdev: net_device structure to be passed packet
821 * 899 *
822 * iommu-unmaps the skb, fills out skb structure and passes the data to the 900 * iommu-unmaps the skb, fills out skb structure and passes the data to the
823 * stack. The descriptor state is not changed. 901 * stack. The descriptor state is not changed.
824 */ 902 */
825static void gelic_net_pass_skb_up(struct gelic_descr *descr, 903static void gelic_net_pass_skb_up(struct gelic_descr *descr,
826 struct gelic_card *card) 904 struct gelic_card *card,
905 struct net_device *netdev)
906
827{ 907{
828 struct sk_buff *skb; 908 struct sk_buff *skb = descr->skb;
829 struct net_device *netdev;
830 u32 data_status, data_error; 909 u32 data_status, data_error;
831 910
832 data_status = be32_to_cpu(descr->data_status); 911 data_status = be32_to_cpu(descr->data_status);
833 data_error = be32_to_cpu(descr->data_error); 912 data_error = be32_to_cpu(descr->data_error);
834 netdev = card->netdev;
835 /* unmap skb buffer */ 913 /* unmap skb buffer */
836 skb = descr->skb; 914 dma_unmap_single(ctodev(card), be32_to_cpu(descr->buf_addr),
837 dma_unmap_single(ctodev(card), 915 GELIC_NET_MAX_MTU,
838 be32_to_cpu(descr->buf_addr), GELIC_NET_MAX_MTU,
839 DMA_FROM_DEVICE); 916 DMA_FROM_DEVICE);
840 917
841 skb_put(skb, descr->valid_size ? 918 skb_put(skb, be32_to_cpu(descr->valid_size)?
842 be32_to_cpu(descr->valid_size) : 919 be32_to_cpu(descr->valid_size) :
843 be32_to_cpu(descr->result_size)); 920 be32_to_cpu(descr->result_size));
844 if (!descr->valid_size) 921 if (!descr->valid_size)
@@ -866,8 +943,8 @@ static void gelic_net_pass_skb_up(struct gelic_descr *descr,
866 skb->ip_summed = CHECKSUM_NONE; 943 skb->ip_summed = CHECKSUM_NONE;
867 944
868 /* update netdevice statistics */ 945 /* update netdevice statistics */
869 card->netdev->stats.rx_packets++; 946 netdev->stats.rx_packets++;
870 card->netdev->stats.rx_bytes += skb->len; 947 netdev->stats.rx_bytes += skb->len;
871 948
872 /* pass skb up to stack */ 949 /* pass skb up to stack */
873 netif_receive_skb(skb); 950 netif_receive_skb(skb);
@@ -886,7 +963,8 @@ static int gelic_card_decode_one_descr(struct gelic_card *card)
886{ 963{
887 enum gelic_descr_dma_status status; 964 enum gelic_descr_dma_status status;
888 struct gelic_descr_chain *chain = &card->rx_chain; 965 struct gelic_descr_chain *chain = &card->rx_chain;
889 struct gelic_descr *descr = chain->tail; 966 struct gelic_descr *descr = chain->head;
967 struct net_device *netdev = NULL;
890 int dmac_chain_ended; 968 int dmac_chain_ended;
891 969
892 status = gelic_descr_get_status(descr); 970 status = gelic_descr_get_status(descr);
@@ -903,12 +981,30 @@ static int gelic_card_decode_one_descr(struct gelic_card *card)
903 return 0; 981 return 0;
904 } 982 }
905 983
984 /* netdevice select */
985 if (card->vlan_required) {
986 unsigned int i;
987 u16 vid;
988 vid = *(u16 *)(descr->skb->data) & VLAN_VID_MASK;
989 for (i = 0; i < GELIC_PORT_MAX; i++) {
990 if (card->vlan[i].rx == vid) {
991 netdev = card->netdev[i];
992 break;
993 }
994 };
995 if (GELIC_PORT_MAX <= i) {
996 pr_info("%s: unknown packet vid=%x\n", __func__, vid);
997 goto refill;
998 }
999 } else
1000 netdev = card->netdev[GELIC_PORT_ETHERNET];
1001
906 if ((status == GELIC_DESCR_DMA_RESPONSE_ERROR) || 1002 if ((status == GELIC_DESCR_DMA_RESPONSE_ERROR) ||
907 (status == GELIC_DESCR_DMA_PROTECTION_ERROR) || 1003 (status == GELIC_DESCR_DMA_PROTECTION_ERROR) ||
908 (status == GELIC_DESCR_DMA_FORCE_END)) { 1004 (status == GELIC_DESCR_DMA_FORCE_END)) {
909 dev_info(ctodev(card), "dropping RX descriptor with state %x\n", 1005 dev_info(ctodev(card), "dropping RX descriptor with state %x\n",
910 status); 1006 status);
911 card->netdev->stats.rx_dropped++; 1007 netdev->stats.rx_dropped++;
912 goto refill; 1008 goto refill;
913 } 1009 }
914 1010
@@ -936,7 +1032,7 @@ static int gelic_card_decode_one_descr(struct gelic_card *card)
936 } 1032 }
937 1033
938 /* ok, we've got a packet in descr */ 1034 /* ok, we've got a packet in descr */
939 gelic_net_pass_skb_up(descr, card); 1035 gelic_net_pass_skb_up(descr, card, netdev);
940refill: 1036refill:
941 /* 1037 /*
942 * So that always DMAC can see the end 1038 * So that always DMAC can see the end
@@ -954,8 +1050,8 @@ refill:
954 */ 1050 */
955 gelic_descr_prepare_rx(card, descr); 1051 gelic_descr_prepare_rx(card, descr);
956 1052
957 chain->head = descr; 1053 chain->tail = descr;
958 chain->tail = descr->next; 1054 chain->head = descr->next;
959 1055
960 /* 1056 /*
961 * Set this descriptor the end of the chain. 1057 * Set this descriptor the end of the chain.
@@ -976,17 +1072,15 @@ refill:
976 1072
977/** 1073/**
978 * gelic_net_poll - NAPI poll function called by the stack to return packets 1074 * gelic_net_poll - NAPI poll function called by the stack to return packets
979 * @netdev: interface device structure 1075 * @napi: napi structure
980 * @budget: number of packets we can pass to the stack at most 1076 * @budget: number of packets we can pass to the stack at most
981 * 1077 *
982 * returns 0 if no more packets available to the driver/stack. Returns 1, 1078 * returns the number of the processed packets
983 * if the quota is exceeded, but the driver has still packets.
984 * 1079 *
985 */ 1080 */
986static int gelic_net_poll(struct napi_struct *napi, int budget) 1081static int gelic_net_poll(struct napi_struct *napi, int budget)
987{ 1082{
988 struct gelic_card *card = container_of(napi, struct gelic_card, napi); 1083 struct gelic_card *card = container_of(napi, struct gelic_card, napi);
989 struct net_device *netdev = card->netdev;
990 int packets_done = 0; 1084 int packets_done = 0;
991 1085
992 while (packets_done < budget) { 1086 while (packets_done < budget) {
@@ -997,7 +1091,7 @@ static int gelic_net_poll(struct napi_struct *napi, int budget)
997 } 1091 }
998 1092
999 if (packets_done < budget) { 1093 if (packets_done < budget) {
1000 netif_rx_complete(netdev, napi); 1094 napi_complete(napi);
1001 gelic_card_rx_irq_on(card); 1095 gelic_card_rx_irq_on(card);
1002 } 1096 }
1003 return packets_done; 1097 return packets_done;
@@ -1009,7 +1103,7 @@ static int gelic_net_poll(struct napi_struct *napi, int budget)
1009 * 1103 *
1010 * returns 0 on success, <0 on failure 1104 * returns 0 on success, <0 on failure
1011 */ 1105 */
1012static int gelic_net_change_mtu(struct net_device *netdev, int new_mtu) 1106int gelic_net_change_mtu(struct net_device *netdev, int new_mtu)
1013{ 1107{
1014 /* no need to re-alloc skbs or so -- the max mtu is about 2.3k 1108 /* no need to re-alloc skbs or so -- the max mtu is about 2.3k
1015 * and mtu is outbound only anyway */ 1109 * and mtu is outbound only anyway */
@@ -1027,8 +1121,7 @@ static int gelic_net_change_mtu(struct net_device *netdev, int new_mtu)
1027static irqreturn_t gelic_card_interrupt(int irq, void *ptr) 1121static irqreturn_t gelic_card_interrupt(int irq, void *ptr)
1028{ 1122{
1029 unsigned long flags; 1123 unsigned long flags;
1030 struct net_device *netdev = ptr; 1124 struct gelic_card *card = ptr;
1031 struct gelic_card *card = netdev_priv(netdev);
1032 u64 status; 1125 u64 status;
1033 1126
1034 status = card->irq_status; 1127 status = card->irq_status;
@@ -1036,6 +1129,8 @@ static irqreturn_t gelic_card_interrupt(int irq, void *ptr)
1036 if (!status) 1129 if (!status)
1037 return IRQ_NONE; 1130 return IRQ_NONE;
1038 1131
1132 status &= card->irq_mask;
1133
1039 if (card->rx_dma_restart_required) { 1134 if (card->rx_dma_restart_required) {
1040 card->rx_dma_restart_required = 0; 1135 card->rx_dma_restart_required = 0;
1041 gelic_card_enable_rxdmac(card); 1136 gelic_card_enable_rxdmac(card);
@@ -1043,21 +1138,22 @@ static irqreturn_t gelic_card_interrupt(int irq, void *ptr)
1043 1138
1044 if (status & GELIC_CARD_RXINT) { 1139 if (status & GELIC_CARD_RXINT) {
1045 gelic_card_rx_irq_off(card); 1140 gelic_card_rx_irq_off(card);
1046 netif_rx_schedule(netdev, &card->napi); 1141 napi_schedule(&card->napi);
1047 } 1142 }
1048 1143
1049 if (status & GELIC_CARD_TXINT) { 1144 if (status & GELIC_CARD_TXINT) {
1050 spin_lock_irqsave(&card->tx_dma_lock, flags); 1145 spin_lock_irqsave(&card->tx_lock, flags);
1051 card->tx_dma_progress = 0; 1146 card->tx_dma_progress = 0;
1052 gelic_card_release_tx_chain(card, 0); 1147 gelic_card_release_tx_chain(card, 0);
1053 /* kick outstanding tx descriptor if any */ 1148 /* kick outstanding tx descriptor if any */
1054 gelic_card_kick_txdma(card, card->tx_chain.tail); 1149 gelic_card_kick_txdma(card, card->tx_chain.tail);
1055 spin_unlock_irqrestore(&card->tx_dma_lock, flags); 1150 spin_unlock_irqrestore(&card->tx_lock, flags);
1056 } 1151 }
1057 1152
1058 /* ether port status changed */ 1153 /* ether port status changed */
1059 if (status & GELIC_CARD_PORT_STATUS_CHANGED) 1154 if (status & GELIC_CARD_PORT_STATUS_CHANGED)
1060 gelic_card_get_ether_port_status(card, 1); 1155 gelic_card_get_ether_port_status(card, 1);
1156
1061 return IRQ_HANDLED; 1157 return IRQ_HANDLED;
1062} 1158}
1063 1159
@@ -1068,55 +1164,17 @@ static irqreturn_t gelic_card_interrupt(int irq, void *ptr)
1068 * 1164 *
1069 * see Documentation/networking/netconsole.txt 1165 * see Documentation/networking/netconsole.txt
1070 */ 1166 */
1071static void gelic_net_poll_controller(struct net_device *netdev) 1167void gelic_net_poll_controller(struct net_device *netdev)
1072{ 1168{
1073 struct gelic_card *card = netdev_priv(netdev); 1169 struct gelic_card *card = netdev_card(netdev);
1074 1170
1075 gelic_card_set_irq_mask(card, 0); 1171 gelic_card_set_irq_mask(card, 0);
1076 gelic_card_interrupt(netdev->irq, netdev); 1172 gelic_card_interrupt(netdev->irq, netdev);
1077 gelic_card_set_irq_mask(card, card->ghiintmask); 1173 gelic_card_set_irq_mask(card, card->irq_mask);
1078} 1174}
1079#endif /* CONFIG_NET_POLL_CONTROLLER */ 1175#endif /* CONFIG_NET_POLL_CONTROLLER */
1080 1176
1081/** 1177/**
1082 * gelic_card_open - open device and map dma region
1083 * @card: card structure
1084 */
1085static int gelic_card_open(struct gelic_card *card)
1086{
1087 int result;
1088
1089 result = ps3_sb_event_receive_port_setup(card->dev, PS3_BINDING_CPU_ANY,
1090 &card->netdev->irq);
1091
1092 if (result) {
1093 dev_info(ctodev(card),
1094 "%s:%d: recieve_port_setup failed (%d)\n",
1095 __func__, __LINE__, result);
1096 result = -EPERM;
1097 goto fail_alloc_irq;
1098 }
1099
1100 result = request_irq(card->netdev->irq, gelic_card_interrupt,
1101 IRQF_DISABLED, card->netdev->name, card->netdev);
1102
1103 if (result) {
1104 dev_info(ctodev(card), "%s:%d: request_irq failed (%d)\n",
1105 __func__, __LINE__, result);
1106 goto fail_request_irq;
1107 }
1108
1109 return 0;
1110
1111fail_request_irq:
1112 ps3_sb_event_receive_port_destroy(card->dev, card->netdev->irq);
1113 card->netdev->irq = NO_IRQ;
1114fail_alloc_irq:
1115 return result;
1116}
1117
1118
1119/**
1120 * gelic_net_open - called upon ifonfig up 1178 * gelic_net_open - called upon ifonfig up
1121 * @netdev: interface device structure 1179 * @netdev: interface device structure
1122 * 1180 *
@@ -1125,56 +1183,23 @@ fail_alloc_irq:
1125 * gelic_net_open allocates all the descriptors and memory needed for 1183 * gelic_net_open allocates all the descriptors and memory needed for
1126 * operation, sets up multicast list and enables interrupts 1184 * operation, sets up multicast list and enables interrupts
1127 */ 1185 */
1128static int gelic_net_open(struct net_device *netdev) 1186int gelic_net_open(struct net_device *netdev)
1129{ 1187{
1130 struct gelic_card *card = netdev_priv(netdev); 1188 struct gelic_card *card = netdev_card(netdev);
1131
1132 dev_dbg(ctodev(card), " -> %s:%d\n", __func__, __LINE__);
1133 1189
1134 gelic_card_open(card); 1190 dev_dbg(ctodev(card), " -> %s %p\n", __func__, netdev);
1135 1191
1136 if (gelic_card_init_chain(card, &card->tx_chain, 1192 gelic_card_up(card);
1137 card->descr, GELIC_NET_TX_DESCRIPTORS))
1138 goto alloc_tx_failed;
1139 if (gelic_card_init_chain(card, &card->rx_chain,
1140 card->descr + GELIC_NET_TX_DESCRIPTORS,
1141 GELIC_NET_RX_DESCRIPTORS))
1142 goto alloc_rx_failed;
1143
1144 /* head of chain */
1145 card->tx_top = card->tx_chain.head;
1146 card->rx_top = card->rx_chain.head;
1147 dev_dbg(ctodev(card), "descr rx %p, tx %p, size %#lx, num %#x\n",
1148 card->rx_top, card->tx_top, sizeof(struct gelic_descr),
1149 GELIC_NET_RX_DESCRIPTORS);
1150 /* allocate rx skbs */
1151 if (gelic_card_alloc_rx_skbs(card))
1152 goto alloc_skbs_failed;
1153
1154 napi_enable(&card->napi);
1155
1156 card->tx_dma_progress = 0;
1157 card->ghiintmask = GELIC_CARD_RXINT | GELIC_CARD_TXINT |
1158 GELIC_CARD_PORT_STATUS_CHANGED;
1159
1160 gelic_card_set_irq_mask(card, card->ghiintmask);
1161 gelic_card_enable_rxdmac(card);
1162 1193
1163 netif_start_queue(netdev); 1194 netif_start_queue(netdev);
1164 gelic_card_get_ether_port_status(card, 1); 1195 gelic_card_get_ether_port_status(card, 1);
1165 1196
1197 dev_dbg(ctodev(card), " <- %s\n", __func__);
1166 return 0; 1198 return 0;
1167
1168alloc_skbs_failed:
1169 gelic_card_free_chain(card, card->rx_top);
1170alloc_rx_failed:
1171 gelic_card_free_chain(card, card->tx_top);
1172alloc_tx_failed:
1173 return -ENOMEM;
1174} 1199}
1175 1200
1176static void gelic_net_get_drvinfo(struct net_device *netdev, 1201void gelic_net_get_drvinfo(struct net_device *netdev,
1177 struct ethtool_drvinfo *info) 1202 struct ethtool_drvinfo *info)
1178{ 1203{
1179 strncpy(info->driver, DRV_NAME, sizeof(info->driver) - 1); 1204 strncpy(info->driver, DRV_NAME, sizeof(info->driver) - 1);
1180 strncpy(info->version, DRV_VERSION, sizeof(info->version) - 1); 1205 strncpy(info->version, DRV_VERSION, sizeof(info->version) - 1);
@@ -1183,7 +1208,7 @@ static void gelic_net_get_drvinfo(struct net_device *netdev,
1183static int gelic_ether_get_settings(struct net_device *netdev, 1208static int gelic_ether_get_settings(struct net_device *netdev,
1184 struct ethtool_cmd *cmd) 1209 struct ethtool_cmd *cmd)
1185{ 1210{
1186 struct gelic_card *card = netdev_priv(netdev); 1211 struct gelic_card *card = netdev_card(netdev);
1187 1212
1188 gelic_card_get_ether_port_status(card, 0); 1213 gelic_card_get_ether_port_status(card, 0);
1189 1214
@@ -1219,35 +1244,25 @@ static int gelic_ether_get_settings(struct net_device *netdev,
1219 return 0; 1244 return 0;
1220} 1245}
1221 1246
1222static int gelic_net_nway_reset(struct net_device *netdev) 1247u32 gelic_net_get_rx_csum(struct net_device *netdev)
1223{ 1248{
1224 if (netif_running(netdev)) { 1249 struct gelic_card *card = netdev_card(netdev);
1225 gelic_net_stop(netdev);
1226 gelic_net_open(netdev);
1227 }
1228 return 0;
1229}
1230
1231static u32 gelic_net_get_rx_csum(struct net_device *netdev)
1232{
1233 struct gelic_card *card = netdev_priv(netdev);
1234 1250
1235 return card->rx_csum; 1251 return card->rx_csum;
1236} 1252}
1237 1253
1238static int gelic_net_set_rx_csum(struct net_device *netdev, u32 data) 1254int gelic_net_set_rx_csum(struct net_device *netdev, u32 data)
1239{ 1255{
1240 struct gelic_card *card = netdev_priv(netdev); 1256 struct gelic_card *card = netdev_card(netdev);
1241 1257
1242 card->rx_csum = data; 1258 card->rx_csum = data;
1243 return 0; 1259 return 0;
1244} 1260}
1245 1261
1246static struct ethtool_ops gelic_net_ethtool_ops = { 1262static struct ethtool_ops gelic_ether_ethtool_ops = {
1247 .get_drvinfo = gelic_net_get_drvinfo, 1263 .get_drvinfo = gelic_net_get_drvinfo,
1248 .get_settings = gelic_ether_get_settings, 1264 .get_settings = gelic_ether_get_settings,
1249 .get_link = ethtool_op_get_link, 1265 .get_link = ethtool_op_get_link,
1250 .nway_reset = gelic_net_nway_reset,
1251 .get_tx_csum = ethtool_op_get_tx_csum, 1266 .get_tx_csum = ethtool_op_get_tx_csum,
1252 .set_tx_csum = ethtool_op_set_tx_csum, 1267 .set_tx_csum = ethtool_op_set_tx_csum,
1253 .get_rx_csum = gelic_net_get_rx_csum, 1268 .get_rx_csum = gelic_net_get_rx_csum,
@@ -1265,7 +1280,7 @@ static void gelic_net_tx_timeout_task(struct work_struct *work)
1265{ 1280{
1266 struct gelic_card *card = 1281 struct gelic_card *card =
1267 container_of(work, struct gelic_card, tx_timeout_task); 1282 container_of(work, struct gelic_card, tx_timeout_task);
1268 struct net_device *netdev = card->netdev; 1283 struct net_device *netdev = card->netdev[GELIC_PORT_ETHERNET];
1269 1284
1270 dev_info(ctodev(card), "%s:Timed out. Restarting... \n", __func__); 1285 dev_info(ctodev(card), "%s:Timed out. Restarting... \n", __func__);
1271 1286
@@ -1288,11 +1303,11 @@ out:
1288 * 1303 *
1289 * called, if tx hangs. Schedules a task that resets the interface 1304 * called, if tx hangs. Schedules a task that resets the interface
1290 */ 1305 */
1291static void gelic_net_tx_timeout(struct net_device *netdev) 1306void gelic_net_tx_timeout(struct net_device *netdev)
1292{ 1307{
1293 struct gelic_card *card; 1308 struct gelic_card *card;
1294 1309
1295 card = netdev_priv(netdev); 1310 card = netdev_card(netdev);
1296 atomic_inc(&card->tx_timeout_task_counter); 1311 atomic_inc(&card->tx_timeout_task_counter);
1297 if (netdev->flags & IFF_UP) 1312 if (netdev->flags & IFF_UP)
1298 schedule_work(&card->tx_timeout_task); 1313 schedule_work(&card->tx_timeout_task);
@@ -1306,7 +1321,8 @@ static void gelic_net_tx_timeout(struct net_device *netdev)
1306 * 1321 *
1307 * fills out function pointers in the net_device structure 1322 * fills out function pointers in the net_device structure
1308 */ 1323 */
1309static void gelic_ether_setup_netdev_ops(struct net_device *netdev) 1324static void gelic_ether_setup_netdev_ops(struct net_device *netdev,
1325 struct napi_struct *napi)
1310{ 1326{
1311 netdev->open = &gelic_net_open; 1327 netdev->open = &gelic_net_open;
1312 netdev->stop = &gelic_net_stop; 1328 netdev->stop = &gelic_net_stop;
@@ -1316,86 +1332,63 @@ static void gelic_ether_setup_netdev_ops(struct net_device *netdev)
1316 /* tx watchdog */ 1332 /* tx watchdog */
1317 netdev->tx_timeout = &gelic_net_tx_timeout; 1333 netdev->tx_timeout = &gelic_net_tx_timeout;
1318 netdev->watchdog_timeo = GELIC_NET_WATCHDOG_TIMEOUT; 1334 netdev->watchdog_timeo = GELIC_NET_WATCHDOG_TIMEOUT;
1319 netdev->ethtool_ops = &gelic_net_ethtool_ops; 1335 /* NAPI */
1336 netif_napi_add(netdev, napi,
1337 gelic_net_poll, GELIC_NET_NAPI_WEIGHT);
1338 netdev->ethtool_ops = &gelic_ether_ethtool_ops;
1339#ifdef CONFIG_NET_POLL_CONTROLLER
1340 netdev->poll_controller = gelic_net_poll_controller;
1341#endif
1320} 1342}
1321 1343
1322/** 1344/**
1323 * gelic_net_setup_netdev - initialization of net_device 1345 * gelic_ether_setup_netdev - initialization of net_device
1346 * @netdev: net_device structure
1324 * @card: card structure 1347 * @card: card structure
1325 * 1348 *
1326 * Returns 0 on success or <0 on failure 1349 * Returns 0 on success or <0 on failure
1327 * 1350 *
1328 * gelic_net_setup_netdev initializes the net_device structure 1351 * gelic_ether_setup_netdev initializes the net_device structure
1352 * and register it.
1329 **/ 1353 **/
1330static int gelic_net_setup_netdev(struct gelic_card *card) 1354int gelic_net_setup_netdev(struct net_device *netdev, struct gelic_card *card)
1331{ 1355{
1332 struct net_device *netdev = card->netdev;
1333 struct sockaddr addr;
1334 unsigned int i;
1335 int status; 1356 int status;
1336 u64 v1, v2; 1357 u64 v1, v2;
1337 DECLARE_MAC_BUF(mac); 1358 DECLARE_MAC_BUF(mac);
1338 1359
1339 SET_NETDEV_DEV(netdev, &card->dev->core);
1340 spin_lock_init(&card->tx_dma_lock);
1341
1342 card->rx_csum = GELIC_NET_RX_CSUM_DEFAULT;
1343
1344 gelic_ether_setup_netdev_ops(netdev);
1345
1346 netif_napi_add(netdev, &card->napi,
1347 gelic_net_poll, GELIC_NET_NAPI_WEIGHT);
1348
1349 netdev->features = NETIF_F_IP_CSUM; 1360 netdev->features = NETIF_F_IP_CSUM;
1350 1361
1351 status = lv1_net_control(bus_id(card), dev_id(card), 1362 status = lv1_net_control(bus_id(card), dev_id(card),
1352 GELIC_LV1_GET_MAC_ADDRESS, 1363 GELIC_LV1_GET_MAC_ADDRESS,
1353 0, 0, 0, &v1, &v2); 1364 0, 0, 0, &v1, &v2);
1365 v1 <<= 16;
1354 if (status || !is_valid_ether_addr((u8 *)&v1)) { 1366 if (status || !is_valid_ether_addr((u8 *)&v1)) {
1355 dev_info(ctodev(card), 1367 dev_info(ctodev(card),
1356 "%s:lv1_net_control GET_MAC_ADDR failed %d\n", 1368 "%s:lv1_net_control GET_MAC_ADDR failed %d\n",
1357 __func__, status); 1369 __func__, status);
1358 return -EINVAL; 1370 return -EINVAL;
1359 } 1371 }
1360 v1 <<= 16; 1372 memcpy(netdev->dev_addr, &v1, ETH_ALEN);
1361 memcpy(addr.sa_data, &v1, ETH_ALEN);
1362 memcpy(netdev->dev_addr, addr.sa_data, ETH_ALEN);
1363 dev_info(ctodev(card), "MAC addr %s\n",
1364 print_mac(mac, netdev->dev_addr));
1365
1366 card->vlan_index = -1; /* no vlan */
1367 for (i = 0; i < GELIC_NET_VLAN_MAX; i++) {
1368 status = lv1_net_control(bus_id(card), dev_id(card),
1369 GELIC_LV1_GET_VLAN_ID,
1370 i + 1, /* index; one based */
1371 0, 0, &v1, &v2);
1372 if (status == LV1_NO_ENTRY) {
1373 dev_dbg(ctodev(card),
1374 "GELIC_VLAN_ID no entry:%d, VLAN disabled\n",
1375 status);
1376 card->vlan_id[i] = 0;
1377 } else if (status) {
1378 dev_dbg(ctodev(card),
1379 "%s:get vlan id faild, status=%d\n",
1380 __func__, status);
1381 card->vlan_id[i] = 0;
1382 } else {
1383 card->vlan_id[i] = (u32)v1;
1384 dev_dbg(ctodev(card), "vlan_id:%d, %lx\n", i, v1);
1385 }
1386 }
1387 1373
1388 if (card->vlan_id[GELIC_LV1_VLAN_TX_ETHERNET - 1]) { 1374 if (card->vlan_required) {
1389 card->vlan_index = GELIC_LV1_VLAN_TX_ETHERNET - 1;
1390 netdev->hard_header_len += VLAN_HLEN; 1375 netdev->hard_header_len += VLAN_HLEN;
1376 /*
1377 * As vlan is internally used,
1378 * we can not receive vlan packets
1379 */
1380 netdev->features |= NETIF_F_VLAN_CHALLENGED;
1391 } 1381 }
1392 1382
1393 status = register_netdev(netdev); 1383 status = register_netdev(netdev);
1394 if (status) { 1384 if (status) {
1395 dev_err(ctodev(card), "%s:Couldn't register net_device: %d\n", 1385 dev_err(ctodev(card), "%s:Couldn't register %s %d\n",
1396 __func__, status); 1386 __func__, netdev->name, status);
1397 return status; 1387 return status;
1398 } 1388 }
1389 dev_info(ctodev(card), "%s: MAC addr %s\n",
1390 netdev->name,
1391 print_mac(mac, netdev->dev_addr));
1399 1392
1400 return 0; 1393 return 0;
1401} 1394}
@@ -1407,72 +1400,171 @@ static int gelic_net_setup_netdev(struct gelic_card *card)
1407 * 1400 *
1408 * the card and net_device structures are linked to each other 1401 * the card and net_device structures are linked to each other
1409 */ 1402 */
1410static struct gelic_card *gelic_alloc_card_net(void) 1403#define GELIC_ALIGN (32)
1404static struct gelic_card *gelic_alloc_card_net(struct net_device **netdev)
1411{ 1405{
1412 struct net_device *netdev;
1413 struct gelic_card *card; 1406 struct gelic_card *card;
1407 struct gelic_port *port;
1408 void *p;
1414 size_t alloc_size; 1409 size_t alloc_size;
1415
1416 alloc_size = sizeof(*card) +
1417 sizeof(struct gelic_descr) * GELIC_NET_RX_DESCRIPTORS +
1418 sizeof(struct gelic_descr) * GELIC_NET_TX_DESCRIPTORS;
1419 /* 1410 /*
1420 * we assume private data is allocated 32 bytes (or more) aligned 1411 * gelic requires dma descriptor is 32 bytes aligned and
1421 * so that gelic_descr should be 32 bytes aligned. 1412 * the hypervisor requires irq_status is 8 bytes aligned.
1422 * Current alloc_etherdev() does do it because NETDEV_ALIGN
1423 * is 32.
1424 * check this assumption here.
1425 */ 1413 */
1426 BUILD_BUG_ON(NETDEV_ALIGN < 32);
1427 BUILD_BUG_ON(offsetof(struct gelic_card, irq_status) % 8); 1414 BUILD_BUG_ON(offsetof(struct gelic_card, irq_status) % 8);
1428 BUILD_BUG_ON(offsetof(struct gelic_card, descr) % 32); 1415 BUILD_BUG_ON(offsetof(struct gelic_card, descr) % 32);
1416 alloc_size =
1417 sizeof(struct gelic_card) +
1418 sizeof(struct gelic_descr) * GELIC_NET_RX_DESCRIPTORS +
1419 sizeof(struct gelic_descr) * GELIC_NET_TX_DESCRIPTORS +
1420 GELIC_ALIGN - 1;
1429 1421
1430 netdev = alloc_etherdev(alloc_size); 1422 p = kzalloc(alloc_size, GFP_KERNEL);
1431 if (!netdev) 1423 if (!p)
1432 return NULL; 1424 return NULL;
1425 card = PTR_ALIGN(p, GELIC_ALIGN);
1426 card->unalign = p;
1427
1428 /*
1429 * alloc netdev
1430 */
1431 *netdev = alloc_etherdev(sizeof(struct gelic_port));
1432 if (!netdev) {
1433 kfree(card->unalign);
1434 return NULL;
1435 }
1436 port = netdev_priv(*netdev);
1437
1438 /* gelic_port */
1439 port->netdev = *netdev;
1440 port->card = card;
1441 port->type = GELIC_PORT_ETHERNET;
1442
1443 /* gelic_card */
1444 card->netdev[GELIC_PORT_ETHERNET] = *netdev;
1433 1445
1434 card = netdev_priv(netdev);
1435 card->netdev = netdev;
1436 INIT_WORK(&card->tx_timeout_task, gelic_net_tx_timeout_task); 1446 INIT_WORK(&card->tx_timeout_task, gelic_net_tx_timeout_task);
1437 init_waitqueue_head(&card->waitq); 1447 init_waitqueue_head(&card->waitq);
1438 atomic_set(&card->tx_timeout_task_counter, 0); 1448 atomic_set(&card->tx_timeout_task_counter, 0);
1449 init_MUTEX(&card->updown_lock);
1450 atomic_set(&card->users, 0);
1439 1451
1440 return card; 1452 return card;
1441} 1453}
1442 1454
1455static void gelic_card_get_vlan_info(struct gelic_card *card)
1456{
1457 u64 v1, v2;
1458 int status;
1459 unsigned int i;
1460 struct {
1461 int tx;
1462 int rx;
1463 } vlan_id_ix[2] = {
1464 [GELIC_PORT_ETHERNET] = {
1465 .tx = GELIC_LV1_VLAN_TX_ETHERNET,
1466 .rx = GELIC_LV1_VLAN_RX_ETHERNET
1467 },
1468 [GELIC_PORT_WIRELESS] = {
1469 .tx = GELIC_LV1_VLAN_TX_WIRELESS,
1470 .rx = GELIC_LV1_VLAN_RX_WIRELESS
1471 }
1472 };
1473
1474 for (i = 0; i < ARRAY_SIZE(vlan_id_ix); i++) {
1475 /* tx tag */
1476 status = lv1_net_control(bus_id(card), dev_id(card),
1477 GELIC_LV1_GET_VLAN_ID,
1478 vlan_id_ix[i].tx,
1479 0, 0, &v1, &v2);
1480 if (status || !v1) {
1481 if (status != LV1_NO_ENTRY)
1482 dev_dbg(ctodev(card),
1483 "get vlan id for tx(%d) failed(%d)\n",
1484 vlan_id_ix[i].tx, status);
1485 card->vlan[i].tx = 0;
1486 card->vlan[i].rx = 0;
1487 continue;
1488 }
1489 card->vlan[i].tx = (u16)v1;
1490
1491 /* rx tag */
1492 status = lv1_net_control(bus_id(card), dev_id(card),
1493 GELIC_LV1_GET_VLAN_ID,
1494 vlan_id_ix[i].rx,
1495 0, 0, &v1, &v2);
1496 if (status || !v1) {
1497 if (status != LV1_NO_ENTRY)
1498 dev_info(ctodev(card),
1499 "get vlan id for rx(%d) failed(%d)\n",
1500 vlan_id_ix[i].rx, status);
1501 card->vlan[i].tx = 0;
1502 card->vlan[i].rx = 0;
1503 continue;
1504 }
1505 card->vlan[i].rx = (u16)v1;
1506
1507 dev_dbg(ctodev(card), "vlan_id[%d] tx=%02x rx=%02x\n",
1508 i, card->vlan[i].tx, card->vlan[i].rx);
1509 }
1510
1511 if (card->vlan[GELIC_PORT_ETHERNET].tx) {
1512 BUG_ON(!card->vlan[GELIC_PORT_WIRELESS].tx);
1513 card->vlan_required = 1;
1514 } else
1515 card->vlan_required = 0;
1516
1517 /* check wirelss capable firmware */
1518 if (ps3_compare_firmware_version(1, 6, 0) < 0) {
1519 card->vlan[GELIC_PORT_WIRELESS].tx = 0;
1520 card->vlan[GELIC_PORT_WIRELESS].rx = 0;
1521 }
1522
1523 dev_info(ctodev(card), "internal vlan %s\n",
1524 card->vlan_required? "enabled" : "disabled");
1525}
1443/** 1526/**
1444 * ps3_gelic_driver_probe - add a device to the control of this driver 1527 * ps3_gelic_driver_probe - add a device to the control of this driver
1445 */ 1528 */
1446static int ps3_gelic_driver_probe(struct ps3_system_bus_device *dev) 1529static int ps3_gelic_driver_probe(struct ps3_system_bus_device *dev)
1447{ 1530{
1448 struct gelic_card *card = gelic_alloc_card_net(); 1531 struct gelic_card *card;
1532 struct net_device *netdev;
1449 int result; 1533 int result;
1450 1534
1451 if (!card) { 1535 pr_debug("%s: called\n", __func__);
1452 dev_info(&dev->core, "gelic_net_alloc_card failed\n");
1453 result = -ENOMEM;
1454 goto fail_alloc_card;
1455 }
1456
1457 ps3_system_bus_set_driver_data(dev, card);
1458 card->dev = dev;
1459
1460 result = ps3_open_hv_device(dev); 1536 result = ps3_open_hv_device(dev);
1461 1537
1462 if (result) { 1538 if (result) {
1463 dev_dbg(&dev->core, "ps3_open_hv_device failed\n"); 1539 dev_dbg(&dev->core, "%s:ps3_open_hv_device failed\n",
1540 __func__);
1464 goto fail_open; 1541 goto fail_open;
1465 } 1542 }
1466 1543
1467 result = ps3_dma_region_create(dev->d_region); 1544 result = ps3_dma_region_create(dev->d_region);
1468 1545
1469 if (result) { 1546 if (result) {
1470 dev_dbg(&dev->core, "ps3_dma_region_create failed(%d)\n", 1547 dev_dbg(&dev->core, "%s:ps3_dma_region_create failed(%d)\n",
1471 result); 1548 __func__, result);
1472 BUG_ON("check region type"); 1549 BUG_ON("check region type");
1473 goto fail_dma_region; 1550 goto fail_dma_region;
1474 } 1551 }
1475 1552
1553 /* alloc card/netdevice */
1554 card = gelic_alloc_card_net(&netdev);
1555 if (!card) {
1556 dev_info(&dev->core, "%s:gelic_net_alloc_card failed\n",
1557 __func__);
1558 result = -ENOMEM;
1559 goto fail_alloc_card;
1560 }
1561 ps3_system_bus_set_driver_data(dev, card);
1562 card->dev = dev;
1563
1564 /* get internal vlan info */
1565 gelic_card_get_vlan_info(card);
1566
1567 /* setup interrupt */
1476 result = lv1_net_set_interrupt_status_indicator(bus_id(card), 1568 result = lv1_net_set_interrupt_status_indicator(bus_id(card),
1477 dev_id(card), 1569 dev_id(card),
1478 ps3_mm_phys_to_lpar(__pa(&card->irq_status)), 1570 ps3_mm_phys_to_lpar(__pa(&card->irq_status)),
@@ -1480,34 +1572,95 @@ static int ps3_gelic_driver_probe(struct ps3_system_bus_device *dev)
1480 1572
1481 if (result) { 1573 if (result) {
1482 dev_dbg(&dev->core, 1574 dev_dbg(&dev->core,
1483 "lv1_net_set_interrupt_status_indicator failed: %s\n", 1575 "%s:set_interrupt_status_indicator failed: %s\n",
1484 ps3_result(result)); 1576 __func__, ps3_result(result));
1485 result = -EIO; 1577 result = -EIO;
1486 goto fail_status_indicator; 1578 goto fail_status_indicator;
1487 } 1579 }
1488 1580
1489 result = gelic_net_setup_netdev(card); 1581 result = ps3_sb_event_receive_port_setup(dev, PS3_BINDING_CPU_ANY,
1582 &card->irq);
1583
1584 if (result) {
1585 dev_info(ctodev(card),
1586 "%s:gelic_net_open_device failed (%d)\n",
1587 __func__, result);
1588 result = -EPERM;
1589 goto fail_alloc_irq;
1590 }
1591 result = request_irq(card->irq, gelic_card_interrupt,
1592 IRQF_DISABLED, netdev->name, card);
1593
1594 if (result) {
1595 dev_info(ctodev(card), "%s:request_irq failed (%d)\n",
1596 __func__, result);
1597 goto fail_request_irq;
1598 }
1599
1600 /* setup card structure */
1601 card->irq_mask = GELIC_CARD_RXINT | GELIC_CARD_TXINT |
1602 GELIC_CARD_PORT_STATUS_CHANGED;
1603 card->rx_csum = GELIC_CARD_RX_CSUM_DEFAULT;
1604
1605
1606 if (gelic_card_init_chain(card, &card->tx_chain,
1607 card->descr, GELIC_NET_TX_DESCRIPTORS))
1608 goto fail_alloc_tx;
1609 if (gelic_card_init_chain(card, &card->rx_chain,
1610 card->descr + GELIC_NET_TX_DESCRIPTORS,
1611 GELIC_NET_RX_DESCRIPTORS))
1612 goto fail_alloc_rx;
1613
1614 /* head of chain */
1615 card->tx_top = card->tx_chain.head;
1616 card->rx_top = card->rx_chain.head;
1617 dev_dbg(ctodev(card), "descr rx %p, tx %p, size %#lx, num %#x\n",
1618 card->rx_top, card->tx_top, sizeof(struct gelic_descr),
1619 GELIC_NET_RX_DESCRIPTORS);
1620 /* allocate rx skbs */
1621 if (gelic_card_alloc_rx_skbs(card))
1622 goto fail_alloc_skbs;
1623
1624 spin_lock_init(&card->tx_lock);
1625 card->tx_dma_progress = 0;
1490 1626
1627 /* setup net_device structure */
1628 netdev->irq = card->irq;
1629 SET_NETDEV_DEV(netdev, &card->dev->core);
1630 gelic_ether_setup_netdev_ops(netdev, &card->napi);
1631 result = gelic_net_setup_netdev(netdev, card);
1491 if (result) { 1632 if (result) {
1492 dev_dbg(&dev->core, "%s:%d: ps3_dma_region_create failed: " 1633 dev_dbg(&dev->core, "%s: setup_netdev failed %d",
1493 "(%d)\n", __func__, __LINE__, result); 1634 __func__, result);
1494 goto fail_setup_netdev; 1635 goto fail_setup_netdev;
1495 } 1636 }
1496 1637
1638 pr_debug("%s: done\n", __func__);
1497 return 0; 1639 return 0;
1498 1640
1499fail_setup_netdev: 1641fail_setup_netdev:
1642fail_alloc_skbs:
1643 gelic_card_free_chain(card, card->rx_chain.head);
1644fail_alloc_rx:
1645 gelic_card_free_chain(card, card->tx_chain.head);
1646fail_alloc_tx:
1647 free_irq(card->irq, card);
1648 netdev->irq = NO_IRQ;
1649fail_request_irq:
1650 ps3_sb_event_receive_port_destroy(dev, card->irq);
1651fail_alloc_irq:
1500 lv1_net_set_interrupt_status_indicator(bus_id(card), 1652 lv1_net_set_interrupt_status_indicator(bus_id(card),
1501 dev_id(card), 1653 bus_id(card),
1502 0 , 0); 1654 0, 0);
1503fail_status_indicator: 1655fail_status_indicator:
1656 ps3_system_bus_set_driver_data(dev, NULL);
1657 kfree(netdev_card(netdev)->unalign);
1658 free_netdev(netdev);
1659fail_alloc_card:
1504 ps3_dma_region_free(dev->d_region); 1660 ps3_dma_region_free(dev->d_region);
1505fail_dma_region: 1661fail_dma_region:
1506 ps3_close_hv_device(dev); 1662 ps3_close_hv_device(dev);
1507fail_open: 1663fail_open:
1508 ps3_system_bus_set_driver_data(dev, NULL);
1509 free_netdev(card->netdev);
1510fail_alloc_card:
1511 return result; 1664 return result;
1512} 1665}
1513 1666
@@ -1518,6 +1671,28 @@ fail_alloc_card:
1518static int ps3_gelic_driver_remove(struct ps3_system_bus_device *dev) 1671static int ps3_gelic_driver_remove(struct ps3_system_bus_device *dev)
1519{ 1672{
1520 struct gelic_card *card = ps3_system_bus_get_driver_data(dev); 1673 struct gelic_card *card = ps3_system_bus_get_driver_data(dev);
1674 struct net_device *netdev0;
1675 pr_debug("%s: called\n", __func__);
1676
1677 /* stop interrupt */
1678 gelic_card_set_irq_mask(card, 0);
1679
1680 /* turn off DMA, force end */
1681 gelic_card_disable_rxdmac(card);
1682 gelic_card_disable_txdmac(card);
1683
1684 /* release chains */
1685 gelic_card_release_tx_chain(card, 1);
1686 gelic_card_release_rx_chain(card);
1687
1688 gelic_card_free_chain(card, card->tx_top);
1689 gelic_card_free_chain(card, card->rx_top);
1690
1691 netdev0 = card->netdev[GELIC_PORT_ETHERNET];
1692 /* disconnect event port */
1693 free_irq(card->irq, card);
1694 netdev0->irq = NO_IRQ;
1695 ps3_sb_event_receive_port_destroy(card->dev, card->irq);
1521 1696
1522 wait_event(card->waitq, 1697 wait_event(card->waitq,
1523 atomic_read(&card->tx_timeout_task_counter) == 0); 1698 atomic_read(&card->tx_timeout_task_counter) == 0);
@@ -1525,8 +1700,9 @@ static int ps3_gelic_driver_remove(struct ps3_system_bus_device *dev)
1525 lv1_net_set_interrupt_status_indicator(bus_id(card), dev_id(card), 1700 lv1_net_set_interrupt_status_indicator(bus_id(card), dev_id(card),
1526 0 , 0); 1701 0 , 0);
1527 1702
1528 unregister_netdev(card->netdev); 1703 unregister_netdev(netdev0);
1529 free_netdev(card->netdev); 1704 kfree(netdev_card(netdev0)->unalign);
1705 free_netdev(netdev0);
1530 1706
1531 ps3_system_bus_set_driver_data(dev, NULL); 1707 ps3_system_bus_set_driver_data(dev, NULL);
1532 1708
@@ -1534,6 +1710,7 @@ static int ps3_gelic_driver_remove(struct ps3_system_bus_device *dev)
1534 1710
1535 ps3_close_hv_device(dev); 1711 ps3_close_hv_device(dev);
1536 1712
1713 pr_debug("%s: done\n", __func__);
1537 return 0; 1714 return 0;
1538} 1715}
1539 1716
generated by cgit v1.2.2 (git 2.25.0) at 2024-12-20 21:30:02 -0500