summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorGabor Juhos <juhosg@openwrt.org>2012-02-16 08:17:50 +0000
committerGabor Juhos <juhosg@openwrt.org>2012-02-16 08:17:50 +0000
commitf8a56dc8dfc95c04257bfe6a5308f72c99d73aa8 (patch)
tree6daf309e9ddf0ca5d9cba6a5a323258194ca1341
parentd186c17aa65edce07827c5fb18c9e9c2d3a0af46 (diff)
downloadmtk-20170518-f8a56dc8dfc95c04257bfe6a5308f72c99d73aa8.zip
mtk-20170518-f8a56dc8dfc95c04257bfe6a5308f72c99d73aa8.tar.gz
mtk-20170518-f8a56dc8dfc95c04257bfe6a5308f72c99d73aa8.tar.bz2
ramips: raeth: separate ring allocation and setup
SVN-Revision: 30573
-rw-r--r--target/linux/ramips/files/drivers/net/ramips.c134
1 files changed, 90 insertions, 44 deletions
diff --git a/target/linux/ramips/files/drivers/net/ramips.c b/target/linux/ramips/files/drivers/net/ramips.c
index 7f0f8c4..b9979fc 100644
--- a/target/linux/ramips/files/drivers/net/ramips.c
+++ b/target/linux/ramips/files/drivers/net/ramips.c
@@ -102,6 +102,64 @@ ramips_alloc_skb(struct raeth_priv *re)
return skb;
}
+static void
+ramips_ring_setup(struct raeth_priv *re)
+{
+ int len;
+ int i;
+
+ len = NUM_TX_DESC * sizeof(struct ramips_tx_dma);
+ memset(re->tx, 0, len);
+
+ for (i = 0; i < NUM_TX_DESC; i++) {
+ struct ramips_tx_dma *txd;
+
+ txd = &re->tx[i];
+ txd->txd4 = TX_DMA_QN(3) | TX_DMA_PN(1);
+ txd->txd2 = TX_DMA_LSO | TX_DMA_DONE;
+
+ if (re->tx_skb[i] != NULL) {
+ netdev_warn(re->netdev,
+ "dirty skb for TX desc %d\n", i);
+ re->tx_skb[i] = NULL;
+ }
+ }
+
+ len = NUM_RX_DESC * sizeof(struct ramips_rx_dma);
+ memset(re->rx, 0, len);
+
+ for (i = 0; i < NUM_RX_DESC; i++) {
+ dma_addr_t dma_addr;
+
+ BUG_ON(re->rx_skb[i] == NULL);
+ dma_addr = dma_map_single(&re->netdev->dev, re->rx_skb[i]->data,
+ MAX_RX_LENGTH, DMA_FROM_DEVICE);
+ re->rx_dma[i] = dma_addr;
+ re->rx[i].rxd1 = (unsigned int) dma_addr;
+ re->rx[i].rxd2 = RX_DMA_LSO;
+ }
+
+ /* flush descriptors */
+ wmb();
+}
+
+static void
+ramips_ring_cleanup(struct raeth_priv *re)
+{
+ int i;
+
+ for (i = 0; i < NUM_RX_DESC; i++)
+ if (re->rx_skb[i])
+ dma_unmap_single(&re->netdev->dev, re->rx_dma[i],
+ MAX_RX_LENGTH, DMA_FROM_DEVICE);
+
+ for (i = 0; i < NUM_TX_DESC; i++)
+ if (re->tx_skb[i]) {
+ dev_kfree_skb_any(re->tx_skb[i]);
+ re->tx_skb[i] = NULL;
+ }
+}
+
#if defined(CONFIG_RALINK_RT288X) || defined(CONFIG_RALINK_RT3883)
#define RAMIPS_MDIO_RETRY 1000
@@ -481,77 +539,63 @@ ramips_phy_stop(struct raeth_priv *re)
#endif /* CONFIG_RALINK_RT288X || CONFIG_RALINK_RT3883 */
static void
-ramips_cleanup_dma(struct raeth_priv *re)
+ramips_ring_free(struct raeth_priv *re)
{
+ int len;
int i;
for (i = 0; i < NUM_RX_DESC; i++)
- if (re->rx_skb[i]) {
- dma_unmap_single(&re->netdev->dev, re->rx_dma[i],
- MAX_RX_LENGTH, DMA_FROM_DEVICE);
+ if (re->rx_skb[i])
dev_kfree_skb_any(re->rx_skb[i]);
- }
- if (re->rx)
- dma_free_coherent(&re->netdev->dev,
- NUM_RX_DESC * sizeof(struct ramips_rx_dma),
- re->rx, re->rx_desc_dma);
+ if (re->rx) {
+ len = NUM_RX_DESC * sizeof(struct ramips_rx_dma);
+ dma_free_coherent(&re->netdev->dev, len, re->rx,
+ re->rx_desc_dma);
+ }
- if (re->tx)
- dma_free_coherent(&re->netdev->dev,
- NUM_TX_DESC * sizeof(struct ramips_tx_dma),
- re->tx, re->tx_desc_dma);
+ if (re->tx) {
+ len = NUM_TX_DESC * sizeof(struct ramips_tx_dma);
+ dma_free_coherent(&re->netdev->dev, len, re->tx,
+ re->tx_desc_dma);
+ }
}
static int
-ramips_alloc_dma(struct raeth_priv *re)
+ramips_ring_alloc(struct raeth_priv *re)
{
+ int len;
int err = -ENOMEM;
int i;
- re->skb_free_idx = 0;
-
- /* setup tx ring */
- re->tx = dma_alloc_coherent(&re->netdev->dev,
- NUM_TX_DESC * sizeof(struct ramips_tx_dma),
- &re->tx_desc_dma, GFP_ATOMIC);
+ /* allocate tx ring */
+ len = NUM_TX_DESC * sizeof(struct ramips_tx_dma);
+ re->tx = dma_alloc_coherent(&re->netdev->dev, len,
+ &re->tx_desc_dma, GFP_ATOMIC);
if (!re->tx)
goto err_cleanup;
- memset(re->tx, 0, NUM_TX_DESC * sizeof(struct ramips_tx_dma));
- for (i = 0; i < NUM_TX_DESC; i++) {
- re->tx[i].txd2 = TX_DMA_LSO | TX_DMA_DONE;
- re->tx[i].txd4 = TX_DMA_QN(3) | TX_DMA_PN(1);
- }
-
- /* setup rx ring */
- re->rx = dma_alloc_coherent(&re->netdev->dev,
- NUM_RX_DESC * sizeof(struct ramips_rx_dma),
+ /* allocate rx ring */
+ len = NUM_RX_DESC * sizeof(struct ramips_rx_dma);
+ re->rx = dma_alloc_coherent(&re->netdev->dev, len,
&re->rx_desc_dma, GFP_ATOMIC);
if (!re->rx)
goto err_cleanup;
- memset(re->rx, 0, sizeof(struct ramips_rx_dma) * NUM_RX_DESC);
for (i = 0; i < NUM_RX_DESC; i++) {
- dma_addr_t dma_addr;
- struct sk_buff *new_skb;
+ struct sk_buff *skb;
- new_skb = ramips_alloc_skb(re);
- if (!new_skb)
+ skb = ramips_alloc_skb(re);
+ if (!skb)
goto err_cleanup;
- dma_addr = dma_map_single(&re->netdev->dev, new_skb->data,
- MAX_RX_LENGTH, DMA_FROM_DEVICE);
- re->rx_dma[i] = dma_addr;
- re->rx[i].rxd1 = (unsigned int) re->rx_dma[i];
- re->rx[i].rxd2 |= RX_DMA_LSO;
- re->rx_skb[i] = new_skb;
+ re->rx_skb[i] = skb;
}
return 0;
- err_cleanup:
- ramips_cleanup_dma(re);
+err_cleanup:
+ ramips_ring_free(re);
return err;
}
@@ -739,10 +783,11 @@ ramips_eth_open(struct net_device *dev)
if (err)
return err;
- err = ramips_alloc_dma(re);
+ err = ramips_ring_alloc(re);
if (err)
goto err_free_irq;
+ ramips_ring_setup(re);
ramips_hw_set_macaddr(dev->dev_addr);
ramips_setup_dma(re);
@@ -798,7 +843,8 @@ ramips_eth_stop(struct net_device *dev)
netif_stop_queue(dev);
tasklet_kill(&re->tx_housekeeping_tasklet);
tasklet_kill(&re->rx_tasklet);
- ramips_cleanup_dma(re);
+ ramips_ring_cleanup(re);
+ ramips_ring_free(re);
RADEBUG("ramips_eth: stopped\n");
return 0;
}