net: ethernet: mtk_eth_soc: improve support for MT7988
Subsystems (4)
v2 cover net: ethernet: mtk_eth_soc: improve support for MT7988
This series fixes and completes commit 445eb6448ed3b ("net: ethernet:mtk_eth_soc: add basic support for MT7988 SoC") and also adds support for using the in-SoC SRAM to previous MT7986 and MT7981 SoCs.
Changes since v1:
* SRAM is actual memory and doesn't require __iomem
* Introduce stub ADDR64 operations on 32-bit platforms to avoid compiler warning
Daniel Golle (4):
net: ethernet: mtk_eth_soc: fix register definitions for MT7988
net: ethernet: mtk_eth_soc: add reset bits for MT7988
net: ethernet: mtk_eth_soc: add support for in-SoC SRAM
net: ethernet: mtk_eth_soc: support 36-bit DMA addressing on MT7988
drivers/net/ethernet/mediatek/mtk_eth_soc.c | 194 +++++++++++++++----- drivers/net/ethernet/mediatek/mtk_eth_soc.h | 53 +++++- 2 files changed, 197 insertions(+), 50 deletions(-)
base-commit: 7eb6deb3f55678216a6a0e956846c04958093ea5
Signature · 1 line
2.41.0
PATCH v2 1/4 net: ethernet: mtk_eth_soc: fix register definitions for MT7988
More register macros need to be adjusted for the 3rd GMAC on MT7988. Account for added bit in SYSCFG0_SGMII_MASK.
--- drivers/net/ethernet/mediatek/mtk_eth_soc.h | 8 +++++--- 1 file changed, 5 insertions(+), 3 deletions(-)
drivers/net/ethernet/mediatek/mtk_eth_soc.h +5 -3
@@ -133,10 +133,12 @@#define MTK_GDMA_XGDM_SEL BIT(31)/* Unicast Filter MAC Address Register - Low */ -#define MTK_GDMA_MAC_ADRL (x) (0x508 + (x * 0x1000)) +#define MTK_GDMA_MAC_ADRL (x) ({ typeof(x) _x = (x); (_x == MTK_GMAC3_ID) ? \ + 0x548 : 0x508 + (_x * 0x1000); })/* Unicast Filter MAC Address Register - High */ -#define MTK_GDMA_MAC_ADRH (x) (0x50C + (x * 0x1000)) +#define MTK_GDMA_MAC_ADRH (x) ({ typeof(x) _x = (x); (_x == MTK_GMAC3_ID) ? \ + 0x54C : 0x50C + (_x * 0x1000); })/* FE global misc reg*/ #define MTK_FE_GLO_MISC 0x124
@@ -503,7 +505,7 @@#define ETHSYS_SYSCFG0 0x14#define SYSCFG0_GE_MASK 0x3#define SYSCFG0_GE_MODE (x, y) (x << (12 + (y * 2))) -#define SYSCFG0_SGMII_MASK GENMASK(9, 8) +#define SYSCFG0_SGMII_MASK GENMASK(9, 7)#define SYSCFG0_SGMII_GMAC1 ((2 << 8) & SYSCFG0_SGMII_MASK)#define SYSCFG0_SGMII_GMAC2 ((3 << 8) & SYSCFG0_SGMII_MASK)#define SYSCFG0_SGMII_GMAC1_V2 BIT(9)
Signature · 1 line
2.41.0
PATCH v2 2/4 net: ethernet: mtk_eth_soc: add reset bits for MT7988
In reply to Daniel GolleAdd bits needed to reset the frame engine on MT7988.
--- drivers/net/ethernet/mediatek/mtk_eth_soc.c | 76 +++++++++++++++------ drivers/net/ethernet/mediatek/mtk_eth_soc.h | 16 +++-- 2 files changed, 68 insertions(+), 24 deletions(-)
drivers/net/ethernet/mediatek/mtk_eth_soc.c +56 -20
@@ -3613,19 +3613,34 @@ static void mtk_hw_reset(struct mtk_eth *eth) {u32 val; -if (mtk_is_netsys_v2_or_greater (eth)) { +if (mtk_is_netsys_v2_or_greater (eth))regmap_write (eth->ethsys,ETHSYS_FE_RST_CHK_IDLE_EN ,0 ); + +if (mtk_is_netsys_v3_or_greater (eth)) { + val =RSTCTRL_PPE0_V3 ; + +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) + val |=RSTCTRL_PPE1_V3 ; + +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE2 )) + val |=RSTCTRL_PPE2 ; + + val |=RSTCTRL_WDMA0 |RSTCTRL_WDMA1 |RSTCTRL_WDMA2 ; + }else if (mtk_is_netsys_v2_or_greater (eth)) { val =RSTCTRL_PPE0_V2 ; + +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) + val |=RSTCTRL_PPE1 ; }else { val =RSTCTRL_PPE0 ; } -if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) - val |=RSTCTRL_PPE1 ; -ethsys_reset (eth,RSTCTRL_ETH |RSTCTRL_FE | val); -if (mtk_is_netsys_v2_or_greater (eth)) +if (mtk_is_netsys_v3_or_greater (eth)) +regmap_write (eth->ethsys,ETHSYS_FE_RST_CHK_IDLE_EN , +0x6f8ff ); +else if (mtk_is_netsys_v2_or_greater (eth))regmap_write (eth->ethsys,ETHSYS_FE_RST_CHK_IDLE_EN ,0x3ffffff ); }
@@ -3651,13 +3666,21 @@ static void mtk_hw_warm_reset(struct mtk_eth *eth)return ; } -if (mtk_is_netsys_v2_or_greater (eth)) +if (mtk_is_netsys_v3_or_greater (eth)) { + rst_mask =RSTCTRL_ETH |RSTCTRL_PPE0_V3 ; +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) + rst_mask |=RSTCTRL_PPE1_V3 ; +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE2 )) + rst_mask |=RSTCTRL_PPE2 ; + + rst_mask |=RSTCTRL_WDMA0 |RSTCTRL_WDMA1 |RSTCTRL_WDMA2 ; + }else if (mtk_is_netsys_v2_or_greater (eth)) { rst_mask =RSTCTRL_ETH |RSTCTRL_PPE0_V2 ; -else +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) + rst_mask |=RSTCTRL_PPE1 ; + }else { rst_mask =RSTCTRL_ETH |RSTCTRL_PPE0 ; - -if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) - rst_mask |=RSTCTRL_PPE1 ; + }regmap_update_bits (eth->ethsys,ETHSYS_RSTCTRL , rst_mask, rst_mask);
@@ -4009,11 +4032,17 @@ static void mtk_prepare_for_reset(struct mtk_eth *eth)u32 val;int i; -/* disabe FE P3 and P4 */ - val =mtk_r32 (eth,MTK_FE_GLO_CFG ) |MTK_FE_LINK_DOWN_P3 ; -if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) - val |=MTK_FE_LINK_DOWN_P4 ; -mtk_w32 (eth, val,MTK_FE_GLO_CFG ); +/* set FE PPE ports link down */ +for (i =MTK_GMAC1_ID ; + i <= (mtk_is_netsys_v3_or_greater (eth) ?MTK_GMAC3_ID :MTK_GMAC2_ID ); + i +=2 ) { + val =mtk_r32 (eth,MTK_FE_GLO_CFG (i)) |MTK_FE_LINK_DOWN_P (PSE_PPE0_PORT ); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) + val |=MTK_FE_LINK_DOWN_P (PSE_PPE1_PORT ); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE2 )) + val |=MTK_FE_LINK_DOWN_P (PSE_PPE2_PORT ); +mtk_w32 (eth, val,MTK_FE_GLO_CFG (i)); + }/* adjust PPE configurations to prepare for reset */ for (i =0 ; i <ARRAY_SIZE (eth->ppe); i++)
@@ -4074,11 +4103,18 @@ static void mtk_pending_work(struct work_struct *work) } } -/* enabe FE P3 and P4 */ - val =mtk_r32 (eth,MTK_FE_GLO_CFG ) & ~MTK_FE_LINK_DOWN_P3 ; -if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) - val &= ~MTK_FE_LINK_DOWN_P4 ; -mtk_w32 (eth, val,MTK_FE_GLO_CFG ); +/* set FE PPE ports link up */ +for (i =MTK_GMAC1_ID ; + i <= (mtk_is_netsys_v3_or_greater (eth) ?MTK_GMAC3_ID :MTK_GMAC2_ID ); + i +=2 ) { + val =mtk_r32 (eth,MTK_FE_GLO_CFG (i)) & ~MTK_FE_LINK_DOWN_P (PSE_PPE0_PORT ); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE1 )) + val &= ~MTK_FE_LINK_DOWN_P (PSE_PPE1_PORT ); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_RSTCTRL_PPE2 )) + val &= ~MTK_FE_LINK_DOWN_P (PSE_PPE2_PORT ); + +mtk_w32 (eth, val,MTK_FE_GLO_CFG (i)); + }clear_bit (MTK_RESETTING , ð->state);
drivers/net/ethernet/mediatek/mtk_eth_soc.h +12 -4
@@ -76,9 +76,8 @@#define MTK_HW_LRO_SDL_REMAIN_ROOM 1522/* Frame Engine Global Configuration */ -#define MTK_FE_GLO_CFG 0x00 -#define MTK_FE_LINK_DOWN_P3 BIT(11) -#define MTK_FE_LINK_DOWN_P4 BIT(12) +#define MTK_FE_GLO_CFG (x) (((x) == MTK_GMAC3_ID) ? 0x24 : 0x00) +#define MTK_FE_LINK_DOWN_P (x) BIT(((x) + 8) % 16)/* Frame Engine Global Reset Register */ #define MTK_RST_GL 0x04
@@ -522,9 +521,15 @@/* ethernet reset control register */ #define ETHSYS_RSTCTRL 0x34#define RSTCTRL_FE BIT(6) +#define RSTCTRL_WDMA0 BIT(24) +#define RSTCTRL_WDMA1 BIT(25) +#define RSTCTRL_WDMA2 BIT(26)#define RSTCTRL_PPE0 BIT(31)#define RSTCTRL_PPE0_V2 BIT(30)#define RSTCTRL_PPE1 BIT(31) +#define RSTCTRL_PPE0_V3 BIT(29) +#define RSTCTRL_PPE1_V3 BIT(30) +#define RSTCTRL_PPE2 BIT(31)#define RSTCTRL_ETH BIT(23)/* ethernet reset check idle register */
@@ -931,6 +936,7 @@ enum mkt_eth_capabilities {MTK_QDMA_BIT ,MTK_SOC_MT7628_BIT ,MTK_RSTCTRL_PPE1_BIT , +MTK_RSTCTRL_PPE2_BIT , MTK_U3_COPHY_V2_BIT,/* MUX BITS*/
@@ -965,6 +971,7 @@ enum mkt_eth_capabilities {#define MTK_QDMA BIT_ULL(MTK_QDMA_BIT)#define MTK_SOC_MT7628 BIT_ULL(MTK_SOC_MT7628_BIT)#define MTK_RSTCTRL_PPE1 BIT_ULL(MTK_RSTCTRL_PPE1_BIT) +#define MTK_RSTCTRL_PPE2 BIT_ULL(MTK_RSTCTRL_PPE2_BIT)#define MTK_U3_COPHY_V2 BIT_ULL(MTK_U3_COPHY_V2_BIT)#define MTK_ETH_MUX_GDM1_TO_GMAC1_ESW \
@@ -1047,7 +1054,8 @@ enum mkt_eth_capabilities { MTK_MUX_GMAC12_TO_GEPHY_SGMII | MTK_QDMA | \ MTK_RSTCTRL_PPE1) -#define MT7988_CAPS (MTK_GDM1_ESW | MTK_QDMA | MTK_RSTCTRL_PPE1) +#define MT7988_CAPS (MTK_GDM1_ESW | MTK_QDMA | MTK_RSTCTRL_PPE1 | \ + MTK_RSTCTRL_PPE2)struct mtk_tx_dma_desc_info {dma_addr_t addr;
Signature · 1 line
2.41.0
PATCH v2 3/4 net: ethernet: mtk_eth_soc: add support for in-SoC SRAM
In reply to Daniel GolleMT7981, MT7986 and MT7988 come with in-SoC SRAM dedicated for Ethernet DMA rings. Support using the SRAM without breaking existing device tree bindings, ie. only new SoC starting from MT7988 will have the SRAM declared as additional resource in device tree. For MT7981 and MT7986 an offset on top of the main I/O base is used.
--- drivers/net/ethernet/mediatek/mtk_eth_soc.c | 88 ++++++++++++++++----- drivers/net/ethernet/mediatek/mtk_eth_soc.h | 13 ++- 2 files changed, 79 insertions(+), 22 deletions(-)
drivers/net/ethernet/mediatek/mtk_eth_soc.c +69 -19
@@ -1135,10 +1135,13 @@ static int mtk_init_fq_dma(struct mtk_eth *eth)dma_addr_t dma_addr;int i; - eth->scratch_ring =dma_alloc_coherent (eth->dma_dev, - cnt * soc->txrx.txd_size, - ð->phy_scratch_ring, -GFP_KERNEL ); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_SRAM )) + eth->scratch_ring = eth->sram_base; +else + eth->scratch_ring =dma_alloc_coherent (eth->dma_dev, + cnt * soc->txrx.txd_size, + ð->phy_scratch_ring, +GFP_KERNEL );if (unlikely (!eth->scratch_ring))return -ENOMEM ;
@@ -2446,8 +2449,14 @@ static int mtk_tx_alloc(struct mtk_eth *eth)if (!ring->buf) goto no_tx_mem; - ring->dma =dma_alloc_coherent (eth->dma_dev, ring_size * sz, - &ring->phys,GFP_KERNEL ); +if (MTK_HAS_CAPS (soc->caps,MTK_SRAM )) { + ring->dma = eth->sram_base + ring_size * sz; + ring->phys = eth->phy_scratch_ring + ring_size * (dma_addr_t )sz; + }else { + ring->dma =dma_alloc_coherent (eth->dma_dev, ring_size * sz, + &ring->phys,GFP_KERNEL ); + } +if (!ring->dma) goto no_tx_mem;
@@ -2546,8 +2555,7 @@ static void mtk_tx_clean(struct mtk_eth *eth)kfree (ring->buf); ring->buf =NULL ; } - -if (ring->dma) { +if (!MTK_HAS_CAPS (soc->caps,MTK_SRAM ) && ring->dma) {dma_free_coherent (eth->dma_dev, ring->dma_size * soc->txrx.txd_size, ring->dma, ring->phys);
@@ -2566,9 +2574,14 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag) {const struct mtk_reg_map *reg_map = eth->soc->reg_map;struct mtk_rx_ring *ring; -int rx_data_len, rx_dma_size; +int rx_data_len, rx_dma_size, tx_ring_size;int i; +if (MTK_HAS_CAPS (eth->soc->caps,MTK_QDMA )) + tx_ring_size =MTK_QDMA_RING_SIZE ; +else + tx_ring_size =MTK_DMA_SIZE ; +if (rx_flag ==MTK_RX_FLAGS_QDMA ) {if (ring_no)return -EINVAL ;
@@ -2603,9 +2616,20 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag) ring->page_pool = pp; } - ring->dma =dma_alloc_coherent (eth->dma_dev, - rx_dma_size * eth->soc->txrx.rxd_size, - &ring->phys,GFP_KERNEL ); +if (!MTK_HAS_CAPS (eth->soc->caps,MTK_SRAM ) || + rx_flag !=MTK_RX_FLAGS_NORMAL ) { + ring->dma =dma_alloc_coherent (eth->dma_dev, + rx_dma_size * eth->soc->txrx.rxd_size, + &ring->phys,GFP_KERNEL ); + }else { +struct mtk_tx_ring *tx_ring = ð->tx_ring; + + ring->dma = tx_ring->dma + tx_ring_size * + eth->soc->txrx.txd_size * (ring_no +1 ); + ring->phys = tx_ring->phys + tx_ring_size * + eth->soc->txrx.txd_size * (ring_no +1 ); + } +if (!ring->dma)return -ENOMEM ;
@@ -2690,7 +2714,7 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag)return 0 ; } -static void mtk_rx_clean (struct mtk_eth *eth,struct mtk_rx_ring *ring) +static void mtk_rx_clean (struct mtk_eth *eth,struct mtk_rx_ring *ring,bool in_sram) {int i;
@@ -2713,7 +2737,7 @@ static void mtk_rx_clean(struct mtk_eth *eth, struct mtk_rx_ring *ring) ring->data =NULL ; } -if (ring->dma) { +if (!in_sram && ring->dma) {dma_free_coherent (eth->dma_dev, ring->dma_size * eth->soc->txrx.rxd_size, ring->dma, ring->phys);
@@ -3073,7 +3097,7 @@ static void mtk_dma_free(struct mtk_eth *eth)for (i =0 ; i <MTK_MAX_DEVS ; i++)if (eth->netdev[i])netdev_reset_queue (eth->netdev[i]); -if (eth->scratch_ring) { +if (!MTK_HAS_CAPS (soc->caps,MTK_SRAM ) && eth->scratch_ring) {dma_free_coherent (eth->dma_dev,MTK_QDMA_RING_SIZE * soc->txrx.txd_size, eth->scratch_ring, eth->phy_scratch_ring);
@@ -3081,13 +3105,13 @@ static void mtk_dma_free(struct mtk_eth *eth) eth->phy_scratch_ring =0 ; }mtk_tx_clean (eth); -mtk_rx_clean (eth, ð->rx_ring[0 ]); -mtk_rx_clean (eth, ð->rx_ring_qdma); +mtk_rx_clean (eth, ð->rx_ring[0 ],MTK_HAS_CAPS (soc->caps,MTK_SRAM )); +mtk_rx_clean (eth, ð->rx_ring_qdma, false);if (eth->hwlro) {mtk_hwlro_rx_uninit (eth);for (i =1 ; i <MTK_MAX_RX_RING_NUM ; i++) -mtk_rx_clean (eth, ð->rx_ring[i]); +mtk_rx_clean (eth, ð->rx_ring[i], false); }kfree (eth->scratch_head);
@@ -4676,7 +4700,7 @@ static int mtk_sgmii_init(struct mtk_eth *eth)static int mtk_probe (struct platform_device *pdev) { -struct resource *res =NULL ; +struct resource *res =NULL , *res_sram;struct device_node *mac_np;struct mtk_eth *eth;int err, i;
@@ -4696,6 +4720,20 @@ static int mtk_probe(struct platform_device *pdev)if (MTK_HAS_CAPS (eth->soc->caps,MTK_SOC_MT7628 )) eth->ip_align =NET_IP_ALIGN ; +if (MTK_HAS_CAPS (eth->soc->caps,MTK_SRAM )) { +/* SRAM is actual memory and supports transparent access just like DRAM. +* Hence we don't require __iomem being set and don't need to use accessor +* functions to read from or write to SRAM. +*/ +if (mtk_is_netsys_v3_or_greater (eth)) { + eth->sram_base = (void __force *)devm_platform_ioremap_resource (pdev,1 ); +if (IS_ERR (eth->sram_base)) +return PTR_ERR (eth->sram_base); + }else { + eth->sram_base = (void __force *)eth->base +MTK_ETH_SRAM_OFFSET ; + } + } +spin_lock_init (ð->page_lock);spin_lock_init (ð->tx_irq_lock);spin_lock_init (ð->rx_irq_lock);
@@ -4759,6 +4797,18 @@ static int mtk_probe(struct platform_device *pdev) err = -EINVAL ; goto err_destroy_sgmii; } +if (MTK_HAS_CAPS (eth->soc->caps,MTK_SRAM )) { +if (mtk_is_netsys_v3_or_greater (eth)) { + res_sram =platform_get_resource (pdev,IORESOURCE_MEM ,1 ); +if (!res_sram) { + err = -EINVAL ; + goto err_destroy_sgmii; + } + eth->phy_scratch_ring = res_sram->start; + }else { + eth->phy_scratch_ring = res->start +MTK_ETH_SRAM_OFFSET ; + } + } }if (eth->soc->offload_version) {
drivers/net/ethernet/mediatek/mtk_eth_soc.h +10 -3
@@ -139,6 +139,9 @@#define MTK_GDMA_MAC_ADRH (x) ({ typeof(x) _x = (x); (_x == MTK_GMAC3_ID) ? \ 0x54C : 0x50C + (_x * 0x1000); }) +/* Internal SRAM offset */ +#define MTK_ETH_SRAM_OFFSET 0x40000 +/* FE global misc reg*/ #define MTK_FE_GLO_MISC 0x124
@@ -938,6 +941,7 @@ enum mkt_eth_capabilities {MTK_RSTCTRL_PPE1_BIT ,MTK_RSTCTRL_PPE2_BIT ,MTK_U3_COPHY_V2_BIT , +MTK_SRAM_BIT ,/* MUX BITS*/ MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT,
@@ -973,6 +977,7 @@ enum mkt_eth_capabilities {#define MTK_RSTCTRL_PPE1 BIT_ULL(MTK_RSTCTRL_PPE1_BIT)#define MTK_RSTCTRL_PPE2 BIT_ULL(MTK_RSTCTRL_PPE2_BIT)#define MTK_U3_COPHY_V2 BIT_ULL(MTK_U3_COPHY_V2_BIT) +#define MTK_SRAM BIT_ULL(MTK_SRAM_BIT)#define MTK_ETH_MUX_GDM1_TO_GMAC1_ESW \ BIT_ULL(MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT)
@@ -1048,14 +1053,14 @@ enum mkt_eth_capabilities {#define MT7981_CAPS (MTK_GMAC1_SGMII | MTK_GMAC2_SGMII | MTK_GMAC2_GEPHY | \ MTK_MUX_GMAC12_TO_GEPHY_SGMII | MTK_QDMA | \ MTK_MUX_U3_GMAC2_TO_QPHY | MTK_U3_COPHY_V2 | \ - MTK_RSTCTRL_PPE1) + MTK_RSTCTRL_PPE1 | MTK_SRAM)#define MT7986_CAPS (MTK_GMAC1_SGMII | MTK_GMAC2_SGMII | \ MTK_MUX_GMAC12_TO_GEPHY_SGMII | MTK_QDMA | \ - MTK_RSTCTRL_PPE1) + MTK_RSTCTRL_PPE1 | MTK_SRAM)#define MT7988_CAPS (MTK_GDM1_ESW | MTK_QDMA | MTK_RSTCTRL_PPE1 | \ - MTK_RSTCTRL_PPE2) + MTK_RSTCTRL_PPE2 | MTK_SRAM)struct mtk_tx_dma_desc_info {dma_addr_t addr;
@@ -1170,6 +1175,7 @@ struct mtk_soc_data {* @dev: The device pointer * @dev: The device pointer used for dma mapping/alloc * @base: The mapped register i/o base +* @sram_base: The mapped SRAM base * @page_lock: Make sure that register operations are atomic * @tx_irq__lock: Make sure that IRQ register operations are atomic * @rx_irq__lock: Make sure that IRQ register operations are atomic
@@ -1215,6 +1221,7 @@ struct mtk_eth {struct device *dev;struct device *dma_dev;void __iomem *base; +void *sram_base;spinlock_t page_lock;spinlock_t tx_irq_lock;spinlock_t rx_irq_lock;
Signature · 1 line
2.41.0
PATCH v2 4/4 net: ethernet: mtk_eth_soc: support 36-bit DMA addressing on MT7988
In reply to Daniel GolleSystems having 4 GiB of RAM and more require DMA addressing beyond the current 32-bit limit. Starting from MT7988 the hardware now supports 36-bit DMA addressing, let's use that new capability in the driver to avoid running into swiotlb on systems with 4 GiB of RAM or more.
--- drivers/net/ethernet/mediatek/mtk_eth_soc.c | 34 ++++++++++++++++++--- drivers/net/ethernet/mediatek/mtk_eth_soc.h | 22 +++++++++++-- 2 files changed, 50 insertions(+), 6 deletions(-)
drivers/net/ethernet/mediatek/mtk_eth_soc.c +30 -4
@@ -1136,7 +1136,7 @@ static int mtk_init_fq_dma(struct mtk_eth *eth)int i;if (MTK_HAS_CAPS (eth->soc->caps,MTK_SRAM )) - eth->scratch_ring = eth->sram_base; + eth->scratch_ring = (void __force *)eth->sram_base;else eth->scratch_ring = dma_alloc_coherent(eth->dma_dev, cnt * soc->txrx.txd_size,
@@ -1328,6 +1328,10 @@ static void mtk_tx_set_dma_desc_v2(struct net_device *dev, void *txd, data =TX_DMA_PLEN0 (info->size);if (info->last) data |=TX_DMA_LS0 ; + +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + data |=TX_DMA_PREP_ADDR64 (info->addr); +WRITE_ONCE (desc->txd3, data);/* set forward port */
@@ -1997,6 +2001,7 @@ static int mtk_poll_rx(struct napi_struct *napi, int budget,bool xdp_flush = false;int idx;struct sk_buff *skb; +u64 addr64 =0 ;u8 *data, *new_data;struct mtk_rx_dma_v2 *rxd, trxd;int done =0 , bytes =0 ;
@@ -2112,7 +2117,10 @@ static int mtk_poll_rx(struct napi_struct *napi, int budget, goto release_desc; } -dma_unmap_single (eth->dma_dev, trxd.rxd1, +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + addr64 =RX_DMA_GET_ADDR64 (trxd.rxd2); + +dma_unmap_single (eth->dma_dev, ((u64 )trxd.rxd1 | addr64), ring->buf_size,DMA_FROM_DEVICE ); skb =build_skb (data, ring->frag_size);
@@ -2178,6 +2186,9 @@ static int mtk_poll_rx(struct napi_struct *napi, int budget,else rxd->rxd2 =RX_DMA_PREP_PLEN0 (ring->buf_size); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + rxd->rxd2 |=RX_DMA_PREP_ADDR64 (dma_addr); + ring->calc_idx = idx; done++; }
@@ -2450,7 +2461,7 @@ static int mtk_tx_alloc(struct mtk_eth *eth) goto no_tx_mem;if (MTK_HAS_CAPS (soc->caps,MTK_SRAM )) { - ring->dma = eth->sram_base + ring_size * sz; + ring->dma = (void __force *)eth->sram_base + ring_size * sz; ring->phys = eth->phy_scratch_ring + ring_size * (dma_addr_t )sz; }else { ring->dma = dma_alloc_coherent(eth->dma_dev, ring_size * sz,
@@ -2670,6 +2681,9 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag)else rxd->rxd2 =RX_DMA_PREP_PLEN0 (ring->buf_size); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + rxd->rxd2 |=RX_DMA_PREP_ADDR64 (dma_addr); + rxd->rxd3 =0 ; rxd->rxd4 =0 ;if (mtk_is_netsys_v2_or_greater (eth)) {
@@ -2716,6 +2730,7 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag)static void mtk_rx_clean (struct mtk_eth *eth,struct mtk_rx_ring *ring,bool in_sram) { +u64 addr64 =0 ;int i;if (ring->data && ring->dma) {
@@ -2729,7 +2744,10 @@ static void mtk_rx_clean(struct mtk_eth *eth, struct mtk_rx_ring *ring, bool in_if (!rxd->rxd1)continue ; -dma_unmap_single (eth->dma_dev, rxd->rxd1, +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + addr64 =RX_DMA_GET_ADDR64 (rxd->rxd2); + +dma_unmap_single (eth->dma_dev, ((u64 )rxd->rxd1 | addr64), ring->buf_size,DMA_FROM_DEVICE );mtk_rx_put_buff (ring, ring->data[i], false); }
@@ -4734,6 +4752,14 @@ static int mtk_probe(struct platform_device *pdev) } } +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) { + err =dma_set_mask_and_coherent (&pdev->dev,DMA_BIT_MASK (36 )); +if (err) { +dev_err (&pdev->dev,"Wrong DMA config\n" ); +return -EINVAL ; + } + } +spin_lock_init (ð->page_lock);spin_lock_init (ð->tx_irq_lock);spin_lock_init (ð->rx_irq_lock);
drivers/net/ethernet/mediatek/mtk_eth_soc.h +20 -2
@@ -331,6 +331,14 @@#define TX_DMA_PLEN1 (x) ((x) & eth->soc->txrx.dma_max_len)#define TX_DMA_SWC BIT(14)#define TX_DMA_PQID GENMASK(3, 0) +#define TX_DMA_ADDR64_MASK GENMASK(3, 0) +#if IS_ENABLED (CONFIG_64BIT ) +# define TX_DMA_GET_ADDR64 (x) (((u64)FIELD_GET(TX_DMA_ADDR64_MASK, (x))) << 32) +# define TX_DMA_PREP_ADDR64 (x) FIELD_PREP(TX_DMA_ADDR64_MASK, ((x) >> 32)) +#else +# define TX_DMA_GET_ADDR64 (x) (0) +# define TX_DMA_PREP_ADDR64 (x) (0) +#endif /* PDMA on MT7628 */ #define TX_DMA_DONE BIT(31)
@@ -343,6 +351,14 @@#define RX_DMA_PREP_PLEN0 (x) (((x) & eth->soc->txrx.dma_max_len) << eth->soc->txrx.dma_len_offset)#define RX_DMA_GET_PLEN0 (x) (((x) >> eth->soc->txrx.dma_len_offset) & eth->soc->txrx.dma_max_len)#define RX_DMA_VTAG BIT(15) +#define RX_DMA_ADDR64_MASK GENMASK(3, 0) +#if IS_ENABLED (CONFIG_64BIT ) +# define RX_DMA_GET_ADDR64 (x) (((u64)FIELD_GET(RX_DMA_ADDR64_MASK, (x))) << 32) +# define RX_DMA_PREP_ADDR64 (x) FIELD_PREP(RX_DMA_ADDR64_MASK, ((x) >> 32)) +#else +# define RX_DMA_GET_ADDR64 (x) (0) +# define RX_DMA_PREP_ADDR64 (x) (0) +#endif /* QDMA descriptor rxd3 */ #define RX_DMA_VID (x) ((x) & VLAN_VID_MASK)
@@ -942,6 +958,7 @@ enum mkt_eth_capabilities {MTK_RSTCTRL_PPE2_BIT ,MTK_U3_COPHY_V2_BIT ,MTK_SRAM_BIT , +MTK_36BIT_DMA_BIT ,/* MUX BITS*/ MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT,
@@ -978,6 +995,7 @@ enum mkt_eth_capabilities {#define MTK_RSTCTRL_PPE2 BIT_ULL(MTK_RSTCTRL_PPE2_BIT)#define MTK_U3_COPHY_V2 BIT_ULL(MTK_U3_COPHY_V2_BIT)#define MTK_SRAM BIT_ULL(MTK_SRAM_BIT) +#define MTK_36BIT_DMA BIT_ULL(MTK_36BIT_DMA_BIT)#define MTK_ETH_MUX_GDM1_TO_GMAC1_ESW \ BIT_ULL(MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT)
@@ -1059,8 +1077,8 @@ enum mkt_eth_capabilities { MTK_MUX_GMAC12_TO_GEPHY_SGMII | MTK_QDMA | \ MTK_RSTCTRL_PPE1 | MTK_SRAM) -#define MT7988_CAPS (MTK_GDM1_ESW | MTK_QDMA | MTK_RSTCTRL_PPE1 | \ - MTK_RSTCTRL_PPE2 | MTK_SRAM) +#define MT7988_CAPS (MTK_36BIT_DMA | MTK_GDM1_ESW | MTK_QDMA | \ + MTK_RSTCTRL_PPE1 | MTK_RSTCTRL_PPE2 | MTK_SRAM)struct mtk_tx_dma_desc_info {dma_addr_t addr;
Signature · 1 line
2.41.0
Re: [PATCH net-next v2 4/4] net: ethernet: mtk_eth_soc: support 36-bit DMA addressing on MT7988
Quoted 16 lines · Daniel Golle
Systems having 4 GiB of RAM and more require DMA addressing beyond the current 32-bit limit. Starting from MT7988 the hardware now supports 36-bit DMA addressing, let's use that new capability in the driver to avoid running into swiotlb on systems with 4 GiB of RAM or more.
Signed-off-by Daniel Golle <[email protected]>--- drivers/net/ethernet/mediatek/mtk_eth_soc.c | 34 ++++++++++++++++++--- drivers/net/ethernet/mediatek/mtk_eth_soc.h | 22 +++++++++++-- 2 files changed, 50 insertions(+), 6 deletions(-)drivers/net/ethernet/mediatek/mtk_eth_soc.c +0
-0
drivers/net/ethernet/mediatek/mtk_eth_soc.c static int mtk_init_fq_dma(struct mtk_eth *eth) · line 1139
Quoted 5 lines
drivers/net/ethernet/mediatek/mtk_eth_soc.c +1
-1@@ -1136,7 +1136,7 @@ static int mtk_init_fq_dma(struct mtk_eth *eth)int i;if (MTK_HAS_CAPS (eth->soc->caps,MTK_SRAM )) - eth->scratch_ring = eth->sram_base; + eth->scratch_ring = (void __force *)eth->sram_base;
Ooops that was supposed to go into the previous commit obviously. I will submit v3 after some time with that fixed.
Quoted 162 lines
drivers/net/ethernet/mediatek/mtk_eth_soc.c +29
-3else eth->scratch_ring = dma_alloc_coherent(eth->dma_dev, cnt * soc->txrx.txd_size,@@ -1328,6 +1328,10 @@ static void mtk_tx_set_dma_desc_v2(struct net_device *dev, void *txd, data =TX_DMA_PLEN0 (info->size);if (info->last) data |=TX_DMA_LS0 ; + +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + data |=TX_DMA_PREP_ADDR64 (info->addr); +WRITE_ONCE (desc->txd3, data);/* set forward port */ @@ -1997,6 +2001,7 @@ static int mtk_poll_rx(struct napi_struct *napi, int budget,bool xdp_flush = false;int idx;struct sk_buff *skb; +u64 addr64 =0 ;u8 *data, *new_data;struct mtk_rx_dma_v2 *rxd, trxd;int done =0 , bytes =0 ;@@ -2112,7 +2117,10 @@ static int mtk_poll_rx(struct napi_struct *napi, int budget, goto release_desc; } -dma_unmap_single (eth->dma_dev, trxd.rxd1, +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + addr64 =RX_DMA_GET_ADDR64 (trxd.rxd2); + +dma_unmap_single (eth->dma_dev, ((u64 )trxd.rxd1 | addr64), ring->buf_size,DMA_FROM_DEVICE ); skb =build_skb (data, ring->frag_size);@@ -2178,6 +2186,9 @@ static int mtk_poll_rx(struct napi_struct *napi, int budget,else rxd->rxd2 =RX_DMA_PREP_PLEN0 (ring->buf_size); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + rxd->rxd2 |=RX_DMA_PREP_ADDR64 (dma_addr); + ring->calc_idx = idx; done++; }@@ -2450,7 +2461,7 @@ static int mtk_tx_alloc(struct mtk_eth *eth) goto no_tx_mem;if (MTK_HAS_CAPS (soc->caps,MTK_SRAM )) { - ring->dma = eth->sram_base + ring_size * sz; + ring->dma = (void __force *)eth->sram_base + ring_size * sz; ring->phys = eth->phy_scratch_ring + ring_size * (dma_addr_t )sz; }else { ring->dma = dma_alloc_coherent(eth->dma_dev, ring_size * sz,@@ -2670,6 +2681,9 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag)else rxd->rxd2 =RX_DMA_PREP_PLEN0 (ring->buf_size); +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + rxd->rxd2 |=RX_DMA_PREP_ADDR64 (dma_addr); + rxd->rxd3 =0 ; rxd->rxd4 =0 ;if (mtk_is_netsys_v2_or_greater (eth)) {@@ -2716,6 +2730,7 @@ static int mtk_rx_alloc(struct mtk_eth *eth, int ring_no, int rx_flag)static void mtk_rx_clean (struct mtk_eth *eth,struct mtk_rx_ring *ring,bool in_sram) { +u64 addr64 =0 ;int i;if (ring->data && ring->dma) {@@ -2729,7 +2744,10 @@ static void mtk_rx_clean(struct mtk_eth *eth, struct mtk_rx_ring *ring, bool in_if (!rxd->rxd1)continue ; -dma_unmap_single (eth->dma_dev, rxd->rxd1, +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) + addr64 =RX_DMA_GET_ADDR64 (rxd->rxd2); + +dma_unmap_single (eth->dma_dev, ((u64 )rxd->rxd1 | addr64), ring->buf_size,DMA_FROM_DEVICE );mtk_rx_put_buff (ring, ring->data[i], false); }@@ -4734,6 +4752,14 @@ static int mtk_probe(struct platform_device *pdev) } } +if (MTK_HAS_CAPS (eth->soc->caps,MTK_36BIT_DMA )) { + err =dma_set_mask_and_coherent (&pdev->dev,DMA_BIT_MASK (36 )); +if (err) { +dev_err (&pdev->dev,"Wrong DMA config\n" ); +return -EINVAL ; + } + } +spin_lock_init (ð->page_lock);spin_lock_init (ð->tx_irq_lock);spin_lock_init (ð->rx_irq_lock);drivers/net/ethernet/mediatek/mtk_eth_soc.h +20
-2@@ -331,6 +331,14 @@#define TX_DMA_PLEN1 (x) ((x) & eth->soc->txrx.dma_max_len)#define TX_DMA_SWC BIT(14)#define TX_DMA_PQID GENMASK(3, 0) +#define TX_DMA_ADDR64_MASK GENMASK(3, 0) +#if IS_ENABLED (CONFIG_64BIT ) +# define TX_DMA_GET_ADDR64 (x) (((u64)FIELD_GET(TX_DMA_ADDR64_MASK, (x))) << 32) +# define TX_DMA_PREP_ADDR64 (x) FIELD_PREP(TX_DMA_ADDR64_MASK, ((x) >> 32)) +#else +# define TX_DMA_GET_ADDR64 (x) (0) +# define TX_DMA_PREP_ADDR64 (x) (0) +#endif /* PDMA on MT7628 */ #define TX_DMA_DONE BIT(31)@@ -343,6 +351,14 @@#define RX_DMA_PREP_PLEN0 (x) (((x) & eth->soc->txrx.dma_max_len) << eth->soc->txrx.dma_len_offset)#define RX_DMA_GET_PLEN0 (x) (((x) >> eth->soc->txrx.dma_len_offset) & eth->soc->txrx.dma_max_len)#define RX_DMA_VTAG BIT(15) +#define RX_DMA_ADDR64_MASK GENMASK(3, 0) +#if IS_ENABLED (CONFIG_64BIT ) +# define RX_DMA_GET_ADDR64 (x) (((u64)FIELD_GET(RX_DMA_ADDR64_MASK, (x))) << 32) +# define RX_DMA_PREP_ADDR64 (x) FIELD_PREP(RX_DMA_ADDR64_MASK, ((x) >> 32)) +#else +# define RX_DMA_GET_ADDR64 (x) (0) +# define RX_DMA_PREP_ADDR64 (x) (0) +#endif /* QDMA descriptor rxd3 */ #define RX_DMA_VID (x) ((x) & VLAN_VID_MASK)@@ -942,6 +958,7 @@ enum mkt_eth_capabilities {MTK_RSTCTRL_PPE2_BIT ,MTK_U3_COPHY_V2_BIT ,MTK_SRAM_BIT , +MTK_36BIT_DMA_BIT ,/* MUX BITS*/ MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT,@@ -978,6 +995,7 @@ enum mkt_eth_capabilities {#define MTK_RSTCTRL_PPE2 BIT_ULL(MTK_RSTCTRL_PPE2_BIT)#define MTK_U3_COPHY_V2 BIT_ULL(MTK_U3_COPHY_V2_BIT)#define MTK_SRAM BIT_ULL(MTK_SRAM_BIT) +#define MTK_36BIT_DMA BIT_ULL(MTK_36BIT_DMA_BIT)#define MTK_ETH_MUX_GDM1_TO_GMAC1_ESW \ BIT_ULL(MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT)@@ -1059,8 +1077,8 @@ enum mkt_eth_capabilities { MTK_MUX_GMAC12_TO_GEPHY_SGMII | MTK_QDMA | \ MTK_RSTCTRL_PPE1 | MTK_SRAM) -#define MT7988_CAPS (MTK_GDM1_ESW | MTK_QDMA | MTK_RSTCTRL_PPE1 | \ - MTK_RSTCTRL_PPE2 | MTK_SRAM) +#define MT7988_CAPS (MTK_36BIT_DMA | MTK_GDM1_ESW | MTK_QDMA | \ + MTK_RSTCTRL_PPE1 | MTK_RSTCTRL_PPE2 | MTK_SRAM)struct mtk_tx_dma_desc_info {dma_addr_t addr;Signature · 1 line
2.41.0