generic: 5.15: mtk_eth_soc: backport fix for hang on link up
Backport commit faa5f17fe2
("kernel: mtk_eth_soc: release
MAC_MCR_FORCE_LINK only when MAC is up") to Linux 5.15 as well.
Signed-off-by: Daniel Golle <daniel@makrotopia.org>
This commit is contained in:
parent
694e647784
commit
33d6ba5045
2 changed files with 59 additions and 8 deletions
|
@ -0,0 +1,50 @@
|
||||||
|
From ef5976ae4e117fae9a61bb3c0f8319a917a425ea Mon Sep 17 00:00:00 2001
|
||||||
|
From: Daniel Golle <daniel@makrotopia.org>
|
||||||
|
Date: Mon, 11 Mar 2024 17:43:28 +0000
|
||||||
|
Subject: [PATCH] net: mediatek: mtk_eth_soc: release MAC_MCR_FORCE_LINK only when MAC is up
|
||||||
|
MIME-Version: 1.0
|
||||||
|
Content-Type: text/plain; charset=UTF-8
|
||||||
|
Content-Transfer-Encoding: 8bit
|
||||||
|
|
||||||
|
Clearing bit MAC_MCR_FORCE_LINK which forces the link down too early
|
||||||
|
can result in MAC ending up in a broken/blocked state.
|
||||||
|
|
||||||
|
Fix this by handling this bit in the .mac_link_up and .mac_link_down
|
||||||
|
calls instead of in .mac_finish.
|
||||||
|
|
||||||
|
Fixes: b8fc9f30821ec ("net: ethernet: mediatek: Add basic PHYLINK support")
|
||||||
|
Signed-off-by: Daniel Golle <daniel@makrotopia.org>
|
||||||
|
---
|
||||||
|
drivers/net/ethernet/mediatek/mtk_eth_soc.c | 7 +++----
|
||||||
|
1 file changed, 3 insertions(+), 4 deletions(-)
|
||||||
|
|
||||||
|
--- a/drivers/net/ethernet/mediatek/mtk_eth_soc.c
|
||||||
|
+++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.c
|
||||||
|
@@ -619,8 +619,7 @@ static int mtk_mac_finish(struct phylink
|
||||||
|
mcr_cur = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
|
||||||
|
mcr_new = mcr_cur;
|
||||||
|
mcr_new |= MAC_MCR_IPG_CFG | MAC_MCR_FORCE_MODE |
|
||||||
|
- MAC_MCR_BACKOFF_EN | MAC_MCR_BACKPR_EN | MAC_MCR_FORCE_LINK |
|
||||||
|
- MAC_MCR_RX_FIFO_CLR_DIS;
|
||||||
|
+ MAC_MCR_BACKOFF_EN | MAC_MCR_BACKPR_EN | MAC_MCR_RX_FIFO_CLR_DIS;
|
||||||
|
|
||||||
|
/* Only update control register when needed! */
|
||||||
|
if (mcr_new != mcr_cur)
|
||||||
|
@@ -636,7 +635,7 @@ static void mtk_mac_link_down(struct phy
|
||||||
|
phylink_config);
|
||||||
|
u32 mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
|
||||||
|
|
||||||
|
- mcr &= ~(MAC_MCR_TX_EN | MAC_MCR_RX_EN);
|
||||||
|
+ mcr &= ~(MAC_MCR_TX_EN | MAC_MCR_RX_EN | MAC_MCR_FORCE_LINK);
|
||||||
|
mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
|
||||||
|
}
|
||||||
|
|
||||||
|
@@ -745,7 +744,7 @@ static void mtk_mac_link_up(struct phyli
|
||||||
|
if (rx_pause)
|
||||||
|
mcr |= MAC_MCR_FORCE_RX_FC;
|
||||||
|
|
||||||
|
- mcr |= MAC_MCR_TX_EN | MAC_MCR_RX_EN;
|
||||||
|
+ mcr |= MAC_MCR_TX_EN | MAC_MCR_RX_EN | MAC_MCR_FORCE_LINK;
|
||||||
|
mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
|
||||||
|
}
|
||||||
|
|
|
@ -387,24 +387,25 @@ Signed-off-by: Daniel Golle <daniel@makrotopia.org>
|
||||||
return;
|
return;
|
||||||
|
|
||||||
err_phy:
|
err_phy:
|
||||||
@@ -634,10 +698,13 @@ static void mtk_mac_link_down(struct phy
|
@@ -633,10 +697,14 @@ static void mtk_mac_link_down(struct phy
|
||||||
{
|
{
|
||||||
struct mtk_mac *mac = container_of(config, struct mtk_mac,
|
struct mtk_mac *mac = container_of(config, struct mtk_mac,
|
||||||
phylink_config);
|
phylink_config);
|
||||||
- u32 mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
|
- u32 mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
|
||||||
|
|
||||||
- mcr &= ~(MAC_MCR_TX_EN | MAC_MCR_RX_EN);
|
- mcr &= ~(MAC_MCR_TX_EN | MAC_MCR_RX_EN | MAC_MCR_FORCE_LINK);
|
||||||
- mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
|
- mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
|
||||||
+ if (!mtk_interface_mode_is_xgmii(interface)) {
|
+ if (!mtk_interface_mode_is_xgmii(interface)) {
|
||||||
+ mtk_m32(mac->hw, MAC_MCR_TX_EN | MAC_MCR_RX_EN, 0, MTK_MAC_MCR(mac->id));
|
+ mtk_m32(mac->hw, MAC_MCR_TX_EN | MAC_MCR_RX_EN | MAC_MCR_FORCE_LINK, 0, MTK_MAC_MCR(mac->id));
|
||||||
+ mtk_m32(mac->hw, MTK_XGMAC_FORCE_LINK(mac->id), 0, MTK_XGMAC_STS(mac->id));
|
+ if (mtk_is_netsys_v3_or_greater(eth))
|
||||||
|
+ mtk_m32(mac->hw, MTK_XGMAC_FORCE_LINK(mac->id), 0, MTK_XGMAC_STS(mac->id));
|
||||||
+ } else if (mac->id != MTK_GMAC1_ID) {
|
+ } else if (mac->id != MTK_GMAC1_ID) {
|
||||||
+ mtk_m32(mac->hw, XMAC_MCR_TRX_DISABLE, XMAC_MCR_TRX_DISABLE, MTK_XMAC_MCR(mac->id));
|
+ mtk_m32(mac->hw, XMAC_MCR_TRX_DISABLE, XMAC_MCR_TRX_DISABLE, MTK_XMAC_MCR(mac->id));
|
||||||
+ }
|
+ }
|
||||||
}
|
}
|
||||||
|
|
||||||
static void mtk_set_queue_speed(struct mtk_eth *eth, unsigned int idx,
|
static void mtk_set_queue_speed(struct mtk_eth *eth, unsigned int idx,
|
||||||
@@ -709,13 +776,11 @@ static void mtk_set_queue_speed(struct m
|
@@ -708,13 +776,11 @@ static void mtk_set_queue_speed(struct m
|
||||||
mtk_w32(eth, val, soc->reg_map->qdma.qtx_sch + ofs);
|
mtk_w32(eth, val, soc->reg_map->qdma.qtx_sch + ofs);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -422,7 +423,7 @@ Signed-off-by: Daniel Golle <daniel@makrotopia.org>
|
||||||
u32 mcr;
|
u32 mcr;
|
||||||
|
|
||||||
mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
|
mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
|
||||||
@@ -749,6 +814,55 @@ static void mtk_mac_link_up(struct phyli
|
@@ -748,6 +814,55 @@ static void mtk_mac_link_up(struct phyli
|
||||||
mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
|
mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -478,7 +479,7 @@ Signed-off-by: Daniel Golle <daniel@makrotopia.org>
|
||||||
static const struct phylink_mac_ops mtk_phylink_ops = {
|
static const struct phylink_mac_ops mtk_phylink_ops = {
|
||||||
.validate = phylink_generic_validate,
|
.validate = phylink_generic_validate,
|
||||||
.mac_select_pcs = mtk_mac_select_pcs,
|
.mac_select_pcs = mtk_mac_select_pcs,
|
||||||
@@ -4563,8 +4677,21 @@ static int mtk_add_mac(struct mtk_eth *e
|
@@ -4562,8 +4677,21 @@ static int mtk_add_mac(struct mtk_eth *e
|
||||||
phy_interface_zero(mac->phylink_config.supported_interfaces);
|
phy_interface_zero(mac->phylink_config.supported_interfaces);
|
||||||
__set_bit(PHY_INTERFACE_MODE_INTERNAL,
|
__set_bit(PHY_INTERFACE_MODE_INTERNAL,
|
||||||
mac->phylink_config.supported_interfaces);
|
mac->phylink_config.supported_interfaces);
|
||||||
|
@ -500,7 +501,7 @@ Signed-off-by: Daniel Golle <daniel@makrotopia.org>
|
||||||
phylink = phylink_create(&mac->phylink_config,
|
phylink = phylink_create(&mac->phylink_config,
|
||||||
of_fwnode_handle(mac->of_node),
|
of_fwnode_handle(mac->of_node),
|
||||||
phy_mode, &mtk_phylink_ops);
|
phy_mode, &mtk_phylink_ops);
|
||||||
@@ -4757,6 +4884,13 @@ static int mtk_probe(struct platform_dev
|
@@ -4756,6 +4884,13 @@ static int mtk_probe(struct platform_dev
|
||||||
|
|
||||||
if (err)
|
if (err)
|
||||||
return err;
|
return err;
|
||||||
|
|
Loading…
Reference in a new issue