mirror of
https://github.com/openwrt/openwrt.git
synced 2024-12-25 16:31:13 +00:00
198 lines
6.7 KiB
Diff
198 lines
6.7 KiB
Diff
patches for bgmac backported from net-next/master
|
|
|
|
--- a/drivers/net/ethernet/broadcom/Kconfig
|
|
+++ b/drivers/net/ethernet/broadcom/Kconfig
|
|
@@ -132,7 +132,8 @@ config BNX2X_SRIOV
|
|
|
|
config BGMAC
|
|
tristate "BCMA bus GBit core support"
|
|
- depends on BCMA_HOST_SOC && HAS_DMA
|
|
+ depends on BCMA_HOST_SOC && HAS_DMA && BCM47XX
|
|
+ select PHYLIB
|
|
---help---
|
|
This driver supports GBit MAC and BCM4706 GBit MAC cores on BCMA bus.
|
|
They can be found on BCM47xx SoCs and provide gigabit ethernet.
|
|
--- a/drivers/net/ethernet/broadcom/bgmac.c
|
|
+++ b/drivers/net/ethernet/broadcom/bgmac.c
|
|
@@ -149,6 +149,8 @@ static netdev_tx_t bgmac_dma_tx_add(stru
|
|
dma_desc->ctl0 = cpu_to_le32(ctl0);
|
|
dma_desc->ctl1 = cpu_to_le32(ctl1);
|
|
|
|
+ netdev_sent_queue(net_dev, skb->len);
|
|
+
|
|
wmb();
|
|
|
|
/* Increase ring->end to point empty slot. We tell hardware the first
|
|
@@ -157,6 +159,7 @@ static netdev_tx_t bgmac_dma_tx_add(stru
|
|
if (++ring->end >= BGMAC_TX_RING_SLOTS)
|
|
ring->end = 0;
|
|
bgmac_write(bgmac, ring->mmio_base + BGMAC_DMA_TX_INDEX,
|
|
+ ring->index_base +
|
|
ring->end * sizeof(struct bgmac_dma_desc));
|
|
|
|
/* Always keep one slot free to allow detecting bugged calls. */
|
|
@@ -177,10 +180,13 @@ static void bgmac_dma_tx_free(struct bgm
|
|
struct device *dma_dev = bgmac->core->dma_dev;
|
|
int empty_slot;
|
|
bool freed = false;
|
|
+ unsigned bytes_compl = 0, pkts_compl = 0;
|
|
|
|
/* The last slot that hardware didn't consume yet */
|
|
empty_slot = bgmac_read(bgmac, ring->mmio_base + BGMAC_DMA_TX_STATUS);
|
|
empty_slot &= BGMAC_DMA_TX_STATDPTR;
|
|
+ empty_slot -= ring->index_base;
|
|
+ empty_slot &= BGMAC_DMA_TX_STATDPTR;
|
|
empty_slot /= sizeof(struct bgmac_dma_desc);
|
|
|
|
while (ring->start != empty_slot) {
|
|
@@ -192,6 +198,9 @@ static void bgmac_dma_tx_free(struct bgm
|
|
slot->skb->len, DMA_TO_DEVICE);
|
|
slot->dma_addr = 0;
|
|
|
|
+ bytes_compl += slot->skb->len;
|
|
+ pkts_compl++;
|
|
+
|
|
/* Free memory! :) */
|
|
dev_kfree_skb(slot->skb);
|
|
slot->skb = NULL;
|
|
@@ -205,6 +214,8 @@ static void bgmac_dma_tx_free(struct bgm
|
|
freed = true;
|
|
}
|
|
|
|
+ netdev_completed_queue(bgmac->net_dev, pkts_compl, bytes_compl);
|
|
+
|
|
if (freed && netif_queue_stopped(bgmac->net_dev))
|
|
netif_wake_queue(bgmac->net_dev);
|
|
}
|
|
@@ -274,6 +285,8 @@ static int bgmac_dma_rx_read(struct bgma
|
|
|
|
end_slot = bgmac_read(bgmac, ring->mmio_base + BGMAC_DMA_RX_STATUS);
|
|
end_slot &= BGMAC_DMA_RX_STATDPTR;
|
|
+ end_slot -= ring->index_base;
|
|
+ end_slot &= BGMAC_DMA_RX_STATDPTR;
|
|
end_slot /= sizeof(struct bgmac_dma_desc);
|
|
|
|
ring->end = end_slot;
|
|
@@ -418,9 +431,6 @@ static int bgmac_dma_alloc(struct bgmac
|
|
ring = &bgmac->tx_ring[i];
|
|
ring->num_slots = BGMAC_TX_RING_SLOTS;
|
|
ring->mmio_base = ring_base[i];
|
|
- if (bgmac_dma_unaligned(bgmac, ring, BGMAC_DMA_RING_TX))
|
|
- bgmac_warn(bgmac, "TX on ring 0x%X supports unaligned addressing but this feature is not implemented\n",
|
|
- ring->mmio_base);
|
|
|
|
/* Alloc ring of descriptors */
|
|
size = ring->num_slots * sizeof(struct bgmac_dma_desc);
|
|
@@ -435,6 +445,13 @@ static int bgmac_dma_alloc(struct bgmac
|
|
if (ring->dma_base & 0xC0000000)
|
|
bgmac_warn(bgmac, "DMA address using 0xC0000000 bit(s), it may need translation trick\n");
|
|
|
|
+ ring->unaligned = bgmac_dma_unaligned(bgmac, ring,
|
|
+ BGMAC_DMA_RING_TX);
|
|
+ if (ring->unaligned)
|
|
+ ring->index_base = lower_32_bits(ring->dma_base);
|
|
+ else
|
|
+ ring->index_base = 0;
|
|
+
|
|
/* No need to alloc TX slots yet */
|
|
}
|
|
|
|
@@ -444,9 +461,6 @@ static int bgmac_dma_alloc(struct bgmac
|
|
ring = &bgmac->rx_ring[i];
|
|
ring->num_slots = BGMAC_RX_RING_SLOTS;
|
|
ring->mmio_base = ring_base[i];
|
|
- if (bgmac_dma_unaligned(bgmac, ring, BGMAC_DMA_RING_RX))
|
|
- bgmac_warn(bgmac, "RX on ring 0x%X supports unaligned addressing but this feature is not implemented\n",
|
|
- ring->mmio_base);
|
|
|
|
/* Alloc ring of descriptors */
|
|
size = ring->num_slots * sizeof(struct bgmac_dma_desc);
|
|
@@ -462,6 +476,13 @@ static int bgmac_dma_alloc(struct bgmac
|
|
if (ring->dma_base & 0xC0000000)
|
|
bgmac_warn(bgmac, "DMA address using 0xC0000000 bit(s), it may need translation trick\n");
|
|
|
|
+ ring->unaligned = bgmac_dma_unaligned(bgmac, ring,
|
|
+ BGMAC_DMA_RING_RX);
|
|
+ if (ring->unaligned)
|
|
+ ring->index_base = lower_32_bits(ring->dma_base);
|
|
+ else
|
|
+ ring->index_base = 0;
|
|
+
|
|
/* Alloc RX slots */
|
|
for (j = 0; j < ring->num_slots; j++) {
|
|
err = bgmac_dma_rx_skb_for_slot(bgmac, &ring->slots[j]);
|
|
@@ -489,12 +510,14 @@ static void bgmac_dma_init(struct bgmac
|
|
for (i = 0; i < BGMAC_MAX_TX_RINGS; i++) {
|
|
ring = &bgmac->tx_ring[i];
|
|
|
|
- /* We don't implement unaligned addressing, so enable first */
|
|
- bgmac_dma_tx_enable(bgmac, ring);
|
|
+ if (!ring->unaligned)
|
|
+ bgmac_dma_tx_enable(bgmac, ring);
|
|
bgmac_write(bgmac, ring->mmio_base + BGMAC_DMA_TX_RINGLO,
|
|
lower_32_bits(ring->dma_base));
|
|
bgmac_write(bgmac, ring->mmio_base + BGMAC_DMA_TX_RINGHI,
|
|
upper_32_bits(ring->dma_base));
|
|
+ if (ring->unaligned)
|
|
+ bgmac_dma_tx_enable(bgmac, ring);
|
|
|
|
ring->start = 0;
|
|
ring->end = 0; /* Points the slot that should *not* be read */
|
|
@@ -505,12 +528,14 @@ static void bgmac_dma_init(struct bgmac
|
|
|
|
ring = &bgmac->rx_ring[i];
|
|
|
|
- /* We don't implement unaligned addressing, so enable first */
|
|
- bgmac_dma_rx_enable(bgmac, ring);
|
|
+ if (!ring->unaligned)
|
|
+ bgmac_dma_rx_enable(bgmac, ring);
|
|
bgmac_write(bgmac, ring->mmio_base + BGMAC_DMA_RX_RINGLO,
|
|
lower_32_bits(ring->dma_base));
|
|
bgmac_write(bgmac, ring->mmio_base + BGMAC_DMA_RX_RINGHI,
|
|
upper_32_bits(ring->dma_base));
|
|
+ if (ring->unaligned)
|
|
+ bgmac_dma_rx_enable(bgmac, ring);
|
|
|
|
for (j = 0, dma_desc = ring->cpu_base; j < ring->num_slots;
|
|
j++, dma_desc++) {
|
|
@@ -531,6 +556,7 @@ static void bgmac_dma_init(struct bgmac
|
|
}
|
|
|
|
bgmac_write(bgmac, ring->mmio_base + BGMAC_DMA_RX_INDEX,
|
|
+ ring->index_base +
|
|
ring->num_slots * sizeof(struct bgmac_dma_desc));
|
|
|
|
ring->start = 0;
|
|
@@ -909,9 +935,9 @@ static void bgmac_chip_reset(struct bgma
|
|
u8 et_swtype = 0;
|
|
u8 sw_type = BGMAC_CHIPCTL_1_SW_TYPE_EPHY |
|
|
BGMAC_CHIPCTL_1_IF_TYPE_MII;
|
|
- char buf[2];
|
|
+ char buf[4];
|
|
|
|
- if (bcm47xx_nvram_getenv("et_swtype", buf, 1) > 0) {
|
|
+ if (bcm47xx_nvram_getenv("et_swtype", buf, sizeof(buf)) > 0) {
|
|
if (kstrtou8(buf, 0, &et_swtype))
|
|
bgmac_err(bgmac, "Failed to parse et_swtype (%s)\n",
|
|
buf);
|
|
@@ -970,6 +996,8 @@ static void bgmac_chip_reset(struct bgma
|
|
bgmac_miiconfig(bgmac);
|
|
bgmac_phy_init(bgmac);
|
|
|
|
+ netdev_reset_queue(bgmac->net_dev);
|
|
+
|
|
bgmac->int_status = 0;
|
|
}
|
|
|
|
--- a/drivers/net/ethernet/broadcom/bgmac.h
|
|
+++ b/drivers/net/ethernet/broadcom/bgmac.h
|
|
@@ -384,6 +384,8 @@ struct bgmac_dma_ring {
|
|
u16 mmio_base;
|
|
struct bgmac_dma_desc *cpu_base;
|
|
dma_addr_t dma_base;
|
|
+ u32 index_base; /* Used for unaligned rings only, otherwise 0 */
|
|
+ bool unaligned;
|
|
|
|
struct bgmac_slot_info slots[BGMAC_RX_RING_SLOTS];
|
|
};
|