aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/net/korina.c109
1 files changed, 53 insertions, 56 deletions
diff --git a/drivers/net/korina.c b/drivers/net/korina.c
index 65b8487c1896..a1d8af7d0bcd 100644
--- a/drivers/net/korina.c
+++ b/drivers/net/korina.c
@@ -353,15 +353,20 @@ static int korina_rx(struct net_device *dev, int limit)
353 struct dma_desc *rd = &lp->rd_ring[lp->rx_next_done]; 353 struct dma_desc *rd = &lp->rd_ring[lp->rx_next_done];
354 struct sk_buff *skb, *skb_new; 354 struct sk_buff *skb, *skb_new;
355 u8 *pkt_buf; 355 u8 *pkt_buf;
356 u32 devcs, pkt_len, dmas, rx_free_desc; 356 u32 devcs, pkt_len, dmas;
357 int count; 357 int count;
358 358
359 dma_cache_inv((u32)rd, sizeof(*rd)); 359 dma_cache_inv((u32)rd, sizeof(*rd));
360 360
361 for (count = 0; count < limit; count++) { 361 for (count = 0; count < limit; count++) {
362 skb = lp->rx_skb[lp->rx_next_done];
363 skb_new = NULL;
362 364
363 devcs = rd->devcs; 365 devcs = rd->devcs;
364 366
367 if ((KORINA_RBSIZE - (u32)DMA_COUNT(rd->control)) == 0)
368 break;
369
365 /* Update statistics counters */ 370 /* Update statistics counters */
366 if (devcs & ETH_RX_CRC) 371 if (devcs & ETH_RX_CRC)
367 dev->stats.rx_crc_errors++; 372 dev->stats.rx_crc_errors++;
@@ -384,63 +389,55 @@ static int korina_rx(struct net_device *dev, int limit)
384 * in Rc32434 (errata ref #077) */ 389 * in Rc32434 (errata ref #077) */
385 dev->stats.rx_errors++; 390 dev->stats.rx_errors++;
386 dev->stats.rx_dropped++; 391 dev->stats.rx_dropped++;
387 } 392 } else if ((devcs & ETH_RX_ROK)) {
388
389 while ((rx_free_desc = KORINA_RBSIZE - (u32)DMA_COUNT(rd->control)) != 0) {
390 /* init the var. used for the later
391 * operations within the while loop */
392 skb_new = NULL;
393 pkt_len = RCVPKT_LENGTH(devcs); 393 pkt_len = RCVPKT_LENGTH(devcs);
394 skb = lp->rx_skb[lp->rx_next_done]; 394
395 395 /* must be the (first and) last
396 if ((devcs & ETH_RX_ROK)) { 396 * descriptor then */
397 /* must be the (first and) last 397 pkt_buf = (u8 *)lp->rx_skb[lp->rx_next_done]->data;
398 * descriptor then */ 398
399 pkt_buf = (u8 *)lp->rx_skb[lp->rx_next_done]->data; 399 /* invalidate the cache */
400 400 dma_cache_inv((unsigned long)pkt_buf, pkt_len - 4);
401 /* invalidate the cache */ 401
402 dma_cache_inv((unsigned long)pkt_buf, pkt_len - 4); 402 /* Malloc up new buffer. */
403 403 skb_new = netdev_alloc_skb(dev, KORINA_RBSIZE + 2);
404 /* Malloc up new buffer. */ 404
405 skb_new = netdev_alloc_skb(dev, KORINA_RBSIZE + 2); 405 if (!skb_new)
406 406 break;
407 if (!skb_new) 407 /* Do not count the CRC */
408 break; 408 skb_put(skb, pkt_len - 4);
409 /* Do not count the CRC */ 409 skb->protocol = eth_type_trans(skb, dev);
410 skb_put(skb, pkt_len - 4); 410
411 skb->protocol = eth_type_trans(skb, dev); 411 /* Pass the packet to upper layers */
412 412 netif_receive_skb(skb);
413 /* Pass the packet to upper layers */ 413 dev->stats.rx_packets++;
414 netif_receive_skb(skb); 414 dev->stats.rx_bytes += pkt_len;
415 dev->stats.rx_packets++; 415
416 dev->stats.rx_bytes += pkt_len; 416 /* Update the mcast stats */
417 417 if (devcs & ETH_RX_MP)
418 /* Update the mcast stats */ 418 dev->stats.multicast++;
419 if (devcs & ETH_RX_MP) 419
420 dev->stats.multicast++; 420 lp->rx_skb[lp->rx_next_done] = skb_new;
421
422 lp->rx_skb[lp->rx_next_done] = skb_new;
423 }
424
425 rd->devcs = 0;
426
427 /* Restore descriptor's curr_addr */
428 if (skb_new)
429 rd->ca = CPHYSADDR(skb_new->data);
430 else
431 rd->ca = CPHYSADDR(skb->data);
432
433 rd->control = DMA_COUNT(KORINA_RBSIZE) |
434 DMA_DESC_COD | DMA_DESC_IOD;
435 lp->rd_ring[(lp->rx_next_done - 1) &
436 KORINA_RDS_MASK].control &=
437 ~DMA_DESC_COD;
438
439 lp->rx_next_done = (lp->rx_next_done + 1) & KORINA_RDS_MASK;
440 dma_cache_wback((u32)rd, sizeof(*rd));
441 rd = &lp->rd_ring[lp->rx_next_done];
442 writel(~DMA_STAT_DONE, &lp->rx_dma_regs->dmas);
443 } 421 }
422
423 rd->devcs = 0;
424
425 /* Restore descriptor's curr_addr */
426 if (skb_new)
427 rd->ca = CPHYSADDR(skb_new->data);
428 else
429 rd->ca = CPHYSADDR(skb->data);
430
431 rd->control = DMA_COUNT(KORINA_RBSIZE) |
432 DMA_DESC_COD | DMA_DESC_IOD;
433 lp->rd_ring[(lp->rx_next_done - 1) &
434 KORINA_RDS_MASK].control &=
435 ~DMA_DESC_COD;
436
437 lp->rx_next_done = (lp->rx_next_done + 1) & KORINA_RDS_MASK;
438 dma_cache_wback((u32)rd, sizeof(*rd));
439 rd = &lp->rd_ring[lp->rx_next_done];
440 writel(~DMA_STAT_DONE, &lp->rx_dma_regs->dmas);
444 } 441 }
445 442
446 dmas = readl(&lp->rx_dma_regs->dmas); 443 dmas = readl(&lp->rx_dma_regs->dmas);