ExternalVendorCode/openwrt
1
0
Fork 0
mirror of https://github.com/openwrt/openwrt.git synced 2024-12-30 18:47:06 +00:00
Code Issues Actions 3 Packages Projects Releases Wiki Activity
6983a215d9
openwrt/target/linux/generic/pending-5.15/737-07-net-ethernet-mtk_eth_soc-add-paths-and-SerDes-modes-.patch

1672 lines
55 KiB
Diff
Raw Normal View History

generic: add support for MediaTek NETSYS v3 In order to support Ethernet on the MT7988 SoC add support for NETSYS v3 as well as new paths and USXGMII SerDes to the mtk_eth_soc driver. Signed-off-by: Daniel Golle <daniel@makrotopia.org>
2023-04-30 16:16:12 +00:00
From 20ac14fedba025b6b336a821ea60660afe2d46cd Mon Sep 17 00:00:00 2001
From: Daniel Golle <daniel@makrotopia.org>
Date: Wed, 1 Mar 2023 11:56:04 +0000
Subject: [PATCH 7/7] net: ethernet: mtk_eth_soc: add paths and SerDes modes
for MT7988
MT7988 comes with a built-in 2.5G PHY as well as USXGMII or 10Base-KR
compatible SerDes lanes for external PHYs.
Add support for configuring the MAC and SerDes parts for the new paths.
Signed-off-by: Daniel Golle <daniel@makrotopia.org>
---
drivers/net/ethernet/mediatek/Makefile | 2 +-
drivers/net/ethernet/mediatek/mtk_eth_path.c | 154 ++++-
drivers/net/ethernet/mediatek/mtk_eth_soc.c | 291 +++++++-
drivers/net/ethernet/mediatek/mtk_eth_soc.h | 162 ++++-
drivers/net/ethernet/mediatek/mtk_usxgmii.c | 659 +++++++++++++++++++
5 files changed, 1236 insertions(+), 32 deletions(-)
create mode 100644 drivers/net/ethernet/mediatek/mtk_usxgmii.c
--- a/drivers/net/ethernet/mediatek/Makefile
+++ b/drivers/net/ethernet/mediatek/Makefile
@@ -5,6 +5,7 @@
obj-$(CONFIG_NET_MEDIATEK_SOC) += mtk_eth.o
mtk_eth-y := mtk_eth_soc.o mtk_eth_path.o mtk_ppe.o mtk_ppe_debugfs.o mtk_ppe_offload.o
+mtk_eth-$(CONFIG_NET_MEDIATEK_SOC_USXGMII) += mtk_usxgmii.o
mtk_eth-$(CONFIG_NET_MEDIATEK_SOC_WED) += mtk_wed.o mtk_wed_mcu.o mtk_wed_wo.o
ifdef CONFIG_DEBUG_FS
mtk_eth-$(CONFIG_NET_MEDIATEK_SOC_WED) += mtk_wed_debugfs.o
--- a/drivers/net/ethernet/mediatek/mtk_eth_path.c
+++ b/drivers/net/ethernet/mediatek/mtk_eth_path.c
@@ -31,10 +31,20 @@ static const char *mtk_eth_path_name(u64
return "gmac2_rgmii";
case MTK_ETH_PATH_GMAC2_SGMII:
return "gmac2_sgmii";
+ case MTK_ETH_PATH_GMAC2_2P5GPHY:
+ return "gmac2_2p5gphy";
case MTK_ETH_PATH_GMAC2_GEPHY:
return "gmac2_gephy";
+ case MTK_ETH_PATH_GMAC3_SGMII:
+ return "gmac3_sgmii";
case MTK_ETH_PATH_GDM1_ESW:
return "gdm1_esw";
+ case MTK_ETH_PATH_GMAC1_USXGMII:
+ return "gmac1_usxgmii";
+ case MTK_ETH_PATH_GMAC2_USXGMII:
+ return "gmac2_usxgmii";
+ case MTK_ETH_PATH_GMAC3_USXGMII:
+ return "gmac3_usxgmii";
default:
return "unknown path";
}
@@ -42,8 +52,8 @@ static const char *mtk_eth_path_name(u64
static int set_mux_gdm1_to_gmac1_esw(struct mtk_eth *eth, u64 path)
{
+ u32 val, mask, set, reg;
bool updated = true;
- u32 val, mask, set;
switch (path) {
case MTK_ETH_PATH_GMAC1_SGMII:
@@ -59,10 +69,15 @@ static int set_mux_gdm1_to_gmac1_esw(str
break;
}
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3))
+ reg = MTK_MAC_MISC_V3;
+ else
+ reg = MTK_MAC_MISC;
+
if (updated) {
- val = mtk_r32(eth, MTK_MAC_MISC);
+ val = mtk_r32(eth, reg);
val = (val & mask) | set;
- mtk_w32(eth, val, MTK_MAC_MISC);
+ mtk_w32(eth, val, reg);
}
dev_dbg(eth->dev, "path %s in %s updated = %d\n",
@@ -125,6 +140,31 @@ static int set_mux_u3_gmac2_to_qphy(stru
return 0;
}
+static int set_mux_gmac2_to_2p5gphy(struct mtk_eth *eth, u64 path)
+{
+ unsigned int val = 0;
+ bool updated = true;
+ int mac_id = 0;
+
+ regmap_read(eth->ethsys, ETHSYS_SYSCFG0, &val);
+
+ switch (path) {
+ case MTK_ETH_PATH_GMAC2_2P5GPHY:
+ val &= ~(u32)SYSCFG0_SGMII_GMAC2_V2;
+ mac_id = MTK_GMAC2_ID;
+ break;
+ default:
+ updated = false;
+ break;
+ };
+
+ if (updated)
+ regmap_update_bits(eth->ethsys, ETHSYS_SYSCFG0,
+ SYSCFG0_SGMII_MASK, val);
+
+ return 0;
+}
+
static int set_mux_gmac1_gmac2_to_sgmii_rgmii(struct mtk_eth *eth, u64 path)
{
unsigned int val = 0;
@@ -163,7 +203,61 @@ static int set_mux_gmac1_gmac2_to_sgmii_
return 0;
}
-static int set_mux_gmac12_to_gephy_sgmii(struct mtk_eth *eth, u64 path)
+static int set_mux_gmac123_to_usxgmii(struct mtk_eth *eth, u64 path)
+{
+ unsigned int val = 0;
+ bool updated = true;
+ int mac_id = 0;
+
+ dev_dbg(eth->dev, "path %s in %s updated = %d\n",
+ mtk_eth_path_name(path), __func__, updated);
+
+ /* Disable SYSCFG1 SGMII */
+ regmap_read(eth->ethsys, ETHSYS_SYSCFG0, &val);
+
+ switch (path) {
+ case MTK_ETH_PATH_GMAC1_USXGMII:
+ val &= ~(u32)SYSCFG0_SGMII_GMAC1_V2;
+ mac_id = MTK_GMAC1_ID;
+ break;
+ case MTK_ETH_PATH_GMAC2_USXGMII:
+ val &= ~(u32)SYSCFG0_SGMII_GMAC2_V2;
+ mac_id = MTK_GMAC2_ID;
+ break;
+ case MTK_ETH_PATH_GMAC3_USXGMII:
+ val &= ~(u32)SYSCFG0_SGMII_GMAC3_V2;
+ mac_id = MTK_GMAC3_ID;
+ break;
+ default:
+ updated = false;
+ };
+
+ if (updated) {
+ regmap_update_bits(eth->ethsys, ETHSYS_SYSCFG0,
+ SYSCFG0_SGMII_MASK, val);
+
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3) &&
+ mac_id == MTK_GMAC2_ID) {
+ regmap_update_bits(eth->infra,
+ TOP_MISC_NETSYS_PCS_MUX,
+ NETSYS_PCS_MUX_MASK,
+ MUX_G2_USXGMII_SEL);
+ }
+ }
+
+ /* Enable XGDM Path */
+ val = mtk_r32(eth, MTK_GDMA_EG_CTRL(mac_id));
+ val |= MTK_GDMA_XGDM_SEL;
+ mtk_w32(eth, val, MTK_GDMA_EG_CTRL(mac_id));
+
+ dev_dbg(eth->dev, "path %s in %s updated = %d\n",
+ mtk_eth_path_name(path), __func__, updated);
+
+
+ return 0;
+}
+
+static int set_mux_gmac123_to_gephy_sgmii(struct mtk_eth *eth, u64 path)
{
unsigned int val = 0;
bool updated = true;
@@ -180,6 +274,9 @@ static int set_mux_gmac12_to_gephy_sgmii
case MTK_ETH_PATH_GMAC2_SGMII:
val |= SYSCFG0_SGMII_GMAC2_V2;
break;
+ case MTK_ETH_PATH_GMAC3_SGMII:
+ val |= SYSCFG0_SGMII_GMAC3_V2;
+ break;
default:
updated = false;
}
@@ -208,13 +305,25 @@ static const struct mtk_eth_muxc mtk_eth
.cap_bit = MTK_ETH_MUX_U3_GMAC2_TO_QPHY,
.set_path = set_mux_u3_gmac2_to_qphy,
}, {
+ .name = "mux_gmac2_to_2p5gphy",
+ .cap_bit = MTK_ETH_MUX_GMAC2_TO_2P5GPHY,
+ .set_path = set_mux_gmac2_to_2p5gphy,
+ }, {
.name = "mux_gmac1_gmac2_to_sgmii_rgmii",
.cap_bit = MTK_ETH_MUX_GMAC1_GMAC2_TO_SGMII_RGMII,
.set_path = set_mux_gmac1_gmac2_to_sgmii_rgmii,
}, {
.name = "mux_gmac12_to_gephy_sgmii",
.cap_bit = MTK_ETH_MUX_GMAC12_TO_GEPHY_SGMII,
- .set_path = set_mux_gmac12_to_gephy_sgmii,
+ .set_path = set_mux_gmac123_to_gephy_sgmii,
+ }, {
+ .name = "mux_gmac123_to_gephy_sgmii",
+ .cap_bit = MTK_ETH_MUX_GMAC123_TO_GEPHY_SGMII,
+ .set_path = set_mux_gmac123_to_gephy_sgmii,
+ }, {
+ .name = "mux_gmac123_to_usxgmii",
+ .cap_bit = MTK_ETH_MUX_GMAC123_TO_USXGMII,
+ .set_path = set_mux_gmac123_to_usxgmii,
},
};
@@ -243,16 +352,46 @@ static int mtk_eth_mux_setup(struct mtk_
}
}
+ dev_dbg(eth->dev, "leaving mux_setup %s\n",
+ mtk_eth_path_name(path));
+
out:
return err;
}
+int mtk_gmac_usxgmii_path_setup(struct mtk_eth *eth, int mac_id)
+{
+ u64 path;
+
+ path = (mac_id == MTK_GMAC1_ID) ? MTK_ETH_PATH_GMAC1_USXGMII :
+ (mac_id == MTK_GMAC2_ID) ? MTK_ETH_PATH_GMAC2_USXGMII :
+ MTK_ETH_PATH_GMAC3_USXGMII;
+
+ /* Setup proper MUXes along the path */
+ return mtk_eth_mux_setup(eth, path);
+}
+
int mtk_gmac_sgmii_path_setup(struct mtk_eth *eth, int mac_id)
{
u64 path;
- path = (mac_id == 0) ? MTK_ETH_PATH_GMAC1_SGMII :
- MTK_ETH_PATH_GMAC2_SGMII;
+ path = (mac_id == MTK_GMAC1_ID) ? MTK_ETH_PATH_GMAC1_SGMII :
+ (mac_id == MTK_GMAC2_ID) ? MTK_ETH_PATH_GMAC2_SGMII :
+ MTK_ETH_PATH_GMAC3_SGMII;
+
+ /* Setup proper MUXes along the path */
+ return mtk_eth_mux_setup(eth, path);
+}
+
+int mtk_gmac_2p5gphy_path_setup(struct mtk_eth *eth, int mac_id)
+{
+ u64 path = 0;
+
+ if (mac_id == MTK_GMAC2_ID)
+ path = MTK_ETH_PATH_GMAC2_2P5GPHY;
+
+ if (!path)
+ return -EINVAL;
/* Setup proper MUXes along the path */
return mtk_eth_mux_setup(eth, path);
@@ -282,4 +421,3 @@ int mtk_gmac_rgmii_path_setup(struct mtk
/* Setup proper MUXes along the path */
return mtk_eth_mux_setup(eth, path);
}
-
--- a/drivers/net/ethernet/mediatek/mtk_eth_soc.c
+++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.c
@@ -437,6 +437,23 @@ static void mtk_gmac0_rgmii_adjust(struc
mtk_w32(eth, val, TRGMII_TCK_CTRL);
}
+static void mtk_setup_bridge_switch(struct mtk_eth *eth)
+{
+ int val;
+
+ /* Force Port1 XGMAC Link Up */
+ val = mtk_r32(eth, MTK_XGMAC_STS(MTK_GMAC1_ID));
+ mtk_w32(eth, val | MTK_XGMAC_FORCE_LINK(MTK_GMAC1_ID),
+ MTK_XGMAC_STS(MTK_GMAC1_ID));
+
+ /* Adjust GSW bridge IPG to 11*/
+ val = mtk_r32(eth, MTK_GSW_CFG);
+ val &= ~(GSWTX_IPG_MASK | GSWRX_IPG_MASK);
+ val |= (GSW_IPG_11 << GSWTX_IPG_SHIFT) |
+ (GSW_IPG_11 << GSWRX_IPG_SHIFT);
+ mtk_w32(eth, val, MTK_GSW_CFG);
+}
+
static struct phylink_pcs *mtk_mac_select_pcs(struct phylink_config *config,
phy_interface_t interface)
{
@@ -462,7 +479,7 @@ static void mtk_mac_config(struct phylin
struct mtk_mac *mac = container_of(config, struct mtk_mac,
phylink_config);
struct mtk_eth *eth = mac->hw;
- int val, ge_mode, err = 0;
+ int val, ge_mode, force_link, err = 0;
u32 i;
/* MT76x8 has no hardware settings between for the MAC */
@@ -506,6 +523,23 @@ static void mtk_mac_config(struct phylin
goto init_err;
}
break;
+ case PHY_INTERFACE_MODE_USXGMII:
+ case PHY_INTERFACE_MODE_10GKR:
+ case PHY_INTERFACE_MODE_5GBASER:
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_USXGMII)) {
+ err = mtk_gmac_usxgmii_path_setup(eth, mac->id);
+ if (err)
+ goto init_err;
+ }
+ break;
+ case PHY_INTERFACE_MODE_INTERNAL:
+ if (mac->id == MTK_GMAC2_ID &&
+ MTK_HAS_CAPS(eth->soc->caps, MTK_2P5GPHY)) {
+ err = mtk_gmac_2p5gphy_path_setup(eth, mac->id);
+ if (err)
+ goto init_err;
+ }
+ break;
default:
goto err_phy;
}
@@ -584,14 +618,92 @@ static void mtk_mac_config(struct phylin
SYSCFG0_SGMII_MASK,
~(u32)SYSCFG0_SGMII_MASK);
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3)) {
+ mtk_xfi_pll_enable(eth);
+ mtk_sgmii_reset(eth, mac->id);
+ if (phylink_autoneg_inband(mode))
+ mtk_sgmii_setup_phya_gen1(eth, mac->id);
+ else
+ mtk_sgmii_setup_phya_gen2(eth, mac->id);
+ }
/* Save the syscfg0 value for mac_finish */
mac->syscfg0 = val;
+ } else if (state->interface == PHY_INTERFACE_MODE_USXGMII ||
+ state->interface == PHY_INTERFACE_MODE_10GKR ||
+ state->interface == PHY_INTERFACE_MODE_5GBASER) {
+
+ if (!MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3)) {
+ err = -EINVAL;
+ goto init_err;
+ }
+ if (phylink_autoneg_inband(mode))
+ err = mtk_usxgmii_setup_mode_force(eth, mac->id,
+ state);
+ else
+ err = mtk_usxgmii_setup_mode_an(eth, mac->id,
+ SPEED_10000);
+
+ if (err)
+ goto init_err;
} else if (phylink_autoneg_inband(mode)) {
dev_err(eth->dev,
"In-band mode not supported in non SGMII mode!\n");
return;
}
+ /* Setup gmac */
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3) &&
+ (mtk_interface_mode_is_xgmii(state->interface) ||
+ mac->interface == PHY_INTERFACE_MODE_INTERNAL)) {
+ mtk_w32(mac->hw, MTK_GDMA_XGDM_SEL, MTK_GDMA_EG_CTRL(mac->id));
+ mtk_w32(mac->hw, MAC_MCR_FORCE_LINK_DOWN, MTK_MAC_MCR(mac->id));
+
+ switch (mac->id) {
+ case MTK_GMAC1_ID:
+ mtk_setup_bridge_switch(eth);
+ break;
+ case MTK_GMAC2_ID:
+ force_link = (mac->interface ==
+ PHY_INTERFACE_MODE_INTERNAL) ?
+ MTK_XGMAC_FORCE_LINK(mac->id) : 0;
+ val = mtk_r32(eth, MTK_XGMAC_STS(mac->id));
+ mtk_w32(eth, val | force_link,
+ MTK_XGMAC_STS(mac->id));
+ break;
+ case MTK_GMAC3_ID:
+ val = mtk_r32(eth, MTK_XGMAC_STS(mac->id));
+ mtk_w32(eth, val | MTK_XGMAC_FORCE_LINK(mac->id),
+ MTK_XGMAC_STS(mac->id));
+ break;
+ }
+ } else {
+ val = mtk_r32(eth, MTK_GDMA_EG_CTRL(mac->id));
+ mtk_w32(eth, val & ~MTK_GDMA_XGDM_SEL,
+ MTK_GDMA_EG_CTRL(mac->id));
+
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3)) {
+ switch (mac->id) {
+ case MTK_GMAC2_ID:
+ case MTK_GMAC3_ID:
+ val = mtk_r32(eth, MTK_XGMAC_STS(mac->id));
+ mtk_w32(eth,
+ val & ~MTK_XGMAC_FORCE_LINK(mac->id),
+ MTK_XGMAC_STS(mac->id));
+ break;
+ }
+ }
+
+/*
+ if (mac->type != mac_type) {
+ if (atomic_read(&reset_pending) == 0) {
+ atomic_inc(&force);
+ schedule_work(&eth->pending_work);
+ atomic_inc(&reset_pending);
+ } else
+ atomic_dec(&reset_pending);
+ }
+*/
+ }
return;
err_phy:
@@ -632,11 +744,37 @@ static int mtk_mac_finish(struct phylink
return 0;
}
-static void mtk_mac_pcs_get_state(struct phylink_config *config,
+static void mtk_xgdm_pcs_get_state(struct mtk_mac *mac,
+ struct phylink_link_state *state)
+{
+ u32 sts = mtk_r32(mac->hw, MTK_XGMAC_STS(mac->id));
+
+ if (mac->id == MTK_GMAC2_ID)
+ sts = sts >> 16;
+
+ state->duplex = 1;
+
+ switch (FIELD_GET(MTK_USXGMII_PCS_MODE, sts)) {
+ case 0:
+ state->speed = SPEED_10000;
+ break;
+ case 1:
+ state->speed = SPEED_5000;
+ break;
+ case 2:
+ state->speed = SPEED_2500;
+ break;
+ case 3:
+ state->speed = SPEED_1000;
+ break;
+ }
+
+ state->link = FIELD_GET(MTK_USXGMII_PCS_LINK, sts);
+}
+
+static void mtk_gdm_pcs_get_state(struct mtk_mac *mac,
struct phylink_link_state *state)
{
- struct mtk_mac *mac = container_of(config, struct mtk_mac,
- phylink_config);
u32 pmsr = mtk_r32(mac->hw, MTK_MAC_MSR(mac->id));
state->link = (pmsr & MAC_MSR_LINK);
@@ -664,15 +802,35 @@ static void mtk_mac_pcs_get_state(struct
state->pause |= MLO_PAUSE_TX;
}
+static void mtk_mac_pcs_get_state(struct phylink_config *config,
+ struct phylink_link_state *state)
+{
+ struct mtk_mac *mac = container_of(config, struct mtk_mac,
+ phylink_config);
+
+ if (mtk_interface_mode_is_xgmii(state->interface))
+ mtk_xgdm_pcs_get_state(mac, state);
+ else
+ mtk_gdm_pcs_get_state(mac, state);
+}
+
static void mtk_mac_link_down(struct phylink_config *config, unsigned int mode,
phy_interface_t interface)
{
struct mtk_mac *mac = container_of(config, struct mtk_mac,
phylink_config);
- u32 mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
+ u32 mcr;
- mcr &= ~(MAC_MCR_TX_EN | MAC_MCR_RX_EN);
- mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
+ if (!mtk_interface_mode_is_xgmii(interface)) {
+ mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
+ mcr &= ~(MAC_MCR_TX_EN | MAC_MCR_RX_EN);
+ mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
+ } else if (mac->id != MTK_GMAC1_ID) {
+ mcr = mtk_r32(mac->hw, MTK_XMAC_MCR(mac->id));
+ mcr &= 0xfffffff0;
+ mcr |= XMAC_MCR_TRX_DISABLE;
+ mtk_w32(mac->hw, mcr, MTK_XMAC_MCR(mac->id));
+ }
}
static void mtk_set_queue_speed(struct mtk_eth *eth, unsigned int idx,
@@ -744,13 +902,11 @@ static void mtk_set_queue_speed(struct m
mtk_w32(eth, val, soc->reg_map->qdma.qtx_sch + ofs);
}
-static void mtk_mac_link_up(struct phylink_config *config,
- struct phy_device *phy,
- unsigned int mode, phy_interface_t interface,
- int speed, int duplex, bool tx_pause, bool rx_pause)
+static void mtk_gdm_mac_link_up(struct mtk_mac *mac,
+ struct phy_device *phy,
+ unsigned int mode, phy_interface_t interface,
+ int speed, int duplex, bool tx_pause, bool rx_pause)
{
- struct mtk_mac *mac = container_of(config, struct mtk_mac,
- phylink_config);
u32 mcr;
mcr = mtk_r32(mac->hw, MTK_MAC_MCR(mac->id));
@@ -784,6 +940,47 @@ static void mtk_mac_link_up(struct phyli
mtk_w32(mac->hw, mcr, MTK_MAC_MCR(mac->id));
}
+static void mtk_xgdm_mac_link_up(struct mtk_mac *mac,
+ struct phy_device *phy,
+ unsigned int mode, phy_interface_t interface,
+ int speed, int duplex, bool tx_pause, bool rx_pause)
+{
+ u32 mcr;
+
+ if (mac->id == MTK_GMAC1_ID)
+ return;
+
+ mcr = mtk_r32(mac->hw, MTK_XMAC_MCR(mac->id));
+
+ mcr &= ~(XMAC_MCR_FORCE_TX_FC | XMAC_MCR_FORCE_RX_FC);
+ /* Configure pause modes -
+ * phylink will avoid these for half duplex
+ */
+ if (tx_pause)
+ mcr |= XMAC_MCR_FORCE_TX_FC;
+ if (rx_pause)
+ mcr |= XMAC_MCR_FORCE_RX_FC;
+
+ mcr &= ~(XMAC_MCR_TRX_DISABLE);
+ mtk_w32(mac->hw, mcr, MTK_XMAC_MCR(mac->id));
+}
+
+static void mtk_mac_link_up(struct phylink_config *config,
+ struct phy_device *phy,
+ unsigned int mode, phy_interface_t interface,
+ int speed, int duplex, bool tx_pause, bool rx_pause)
+{
+ struct mtk_mac *mac = container_of(config, struct mtk_mac,
+ phylink_config);
+
+ if (mtk_interface_mode_is_xgmii(interface))
+ mtk_xgdm_mac_link_up(mac, phy, mode, interface, speed, duplex,
+ tx_pause, rx_pause);
+ else
+ mtk_gdm_mac_link_up(mac, phy, mode, interface, speed, duplex,
+ tx_pause, rx_pause);
+}
+
static const struct phylink_mac_ops mtk_phylink_ops = {
.validate = phylink_generic_validate,
.mac_select_pcs = mtk_mac_select_pcs,
@@ -836,10 +1033,21 @@ static int mtk_mdio_init(struct mtk_eth
}
divider = min_t(unsigned int, DIV_ROUND_UP(MDC_MAX_FREQ, max_clk), 63);
+ /* Configure MDC Turbo Mode */
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3)) {
+ val = mtk_r32(eth, MTK_MAC_MISC_V3);
+ val |= MISC_MDC_TURBO;
+ mtk_w32(eth, val, MTK_MAC_MISC_V3);
+ } else {
+ val = mtk_r32(eth, MTK_PPSC);
+ val |= PPSC_MDC_TURBO;
+ mtk_w32(eth, val, MTK_PPSC);
+ }
+
/* Configure MDC Divider */
val = mtk_r32(eth, MTK_PPSC);
val &= ~PPSC_MDC_CFG;
- val |= FIELD_PREP(PPSC_MDC_CFG, divider) | PPSC_MDC_TURBO;
+ val |= FIELD_PREP(PPSC_MDC_CFG, divider);
mtk_w32(eth, val, MTK_PPSC);
dev_dbg(eth->dev, "MDC is running on %d Hz\n", MDC_MAX_FREQ / divider);
@@ -4433,8 +4641,8 @@ static int mtk_add_mac(struct mtk_eth *e
const __be32 *_id = of_get_property(np, "reg", NULL);
phy_interface_t phy_mode;
struct phylink *phylink;
- struct mtk_mac *mac;
int id, err;
+ struct mtk_mac *mac;
int txqs = 1;
if (!_id) {
@@ -4525,6 +4733,32 @@ static int mtk_add_mac(struct mtk_eth *e
mac->phylink_config.supported_interfaces);
}
+ if (MTK_HAS_CAPS(mac->hw->soc->caps, MTK_USXGMII)) {
+ if (id == MTK_GMAC1_ID) {
+ mac->phylink_config.mac_capabilities = MAC_ASYM_PAUSE |
+ MAC_SYM_PAUSE |
+ MAC_10000FD;
+ phy_interface_zero(
+ mac->phylink_config.supported_interfaces);
+ __set_bit(PHY_INTERFACE_MODE_INTERNAL,
+ mac->phylink_config.supported_interfaces);
+ } else {
+ mac->phylink_config.mac_capabilities |= MAC_5000FD | MAC_10000FD;
+ __set_bit(PHY_INTERFACE_MODE_5GBASER,
+ mac->phylink_config.supported_interfaces);
+ __set_bit(PHY_INTERFACE_MODE_10GKR,
+ mac->phylink_config.supported_interfaces);
+ __set_bit(PHY_INTERFACE_MODE_USXGMII,
+ mac->phylink_config.supported_interfaces);
+ }
+ }
+
+ if (MTK_HAS_CAPS(mac->hw->soc->caps, MTK_2P5GPHY)) {
+ if (id == MTK_GMAC2_ID)
+ __set_bit(PHY_INTERFACE_MODE_INTERNAL,
+ mac->phylink_config.supported_interfaces);
+ }
+
phylink = phylink_create(&mac->phylink_config,
of_fwnode_handle(mac->of_node),
phy_mode, &mtk_phylink_ops);
@@ -4714,6 +4948,33 @@ static int mtk_probe(struct platform_dev
return err;
}
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_USXGMII)) {
+ eth->xgmii = devm_kzalloc(eth->dev, sizeof(*eth->xgmii), GFP_KERNEL);
+ err = mtk_usxgmii_init(eth);
+ if (err) {
+ dev_err(&pdev->dev, "usxgmii init failed\n");
+ return err;
+ }
+
+ err = mtk_xfi_pextp_init(eth);
+ if (err) {
+ dev_err(&pdev->dev, "pextp init failed\n");
+ return err;
+ }
+
+ err = mtk_xfi_pll_init(eth);
+ if (err) {
+ dev_err(&pdev->dev, "xfi pll init failed\n");
+ return err;
+ }
+
+ err = mtk_toprgu_init(eth);
+ if (err) {
+ dev_err(&pdev->dev, "toprgu init failed\n");
+ return err;
+ }
+ }
+
if (eth->soc->required_pctl) {
eth->pctl = syscon_regmap_lookup_by_phandle(pdev->dev.of_node,
"mediatek,pctl");
--- a/drivers/net/ethernet/mediatek/mtk_eth_soc.h
+++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.h
@@ -126,6 +126,11 @@
#define MTK_GDMA_TO_PDMA 0x0
#define MTK_GDMA_DROP_ALL 0x7777
+/* GDM Egress Control Register */
+#define MTK_GDMA_EG_CTRL(x) ((x == MTK_GMAC3_ID) ? \
+ 0x544 : 0x504 + (x * 0x1000))
+#define MTK_GDMA_XGDM_SEL BIT(31)
+
/* Unicast Filter MAC Address Register - Low */
#define MTK_GDMA_MAC_ADRL(x) (0x508 + (x * 0x1000))
@@ -386,7 +391,26 @@
#define PHY_IAC_TIMEOUT HZ
#define MTK_MAC_MISC 0x1000c
+#define MTK_MAC_MISC_V3 0x10010
#define MTK_MUX_TO_ESW BIT(0)
+#define MISC_MDC_TURBO BIT(4)
+
+/* XMAC status registers */
+#define MTK_XGMAC_STS(x) ((x == MTK_GMAC3_ID) ? 0x1001C : 0x1000C)
+#define MTK_XGMAC_FORCE_LINK(x) ((x == MTK_GMAC2_ID) ? BIT(31) : BIT(15))
+#define MTK_USXGMII_PCS_LINK BIT(8)
+#define MTK_XGMAC_RX_FC BIT(5)
+#define MTK_XGMAC_TX_FC BIT(4)
+#define MTK_USXGMII_PCS_MODE GENMASK(3, 1)
+#define MTK_XGMAC_LINK_STS BIT(0)
+
+/* GSW bridge registers */
+#define MTK_GSW_CFG (0x10080)
+#define GSWTX_IPG_MASK GENMASK(19, 16)
+#define GSWTX_IPG_SHIFT 16
+#define GSWRX_IPG_MASK GENMASK(3, 0)
+#define GSWRX_IPG_SHIFT 0
+#define GSW_IPG_11 11
/* Mac control registers */
#define MTK_MAC_MCR(x) (0x10100 + (x * 0x100))
@@ -411,6 +435,17 @@
#define MAC_MCR_FORCE_LINK BIT(0)
#define MAC_MCR_FORCE_LINK_DOWN (MAC_MCR_FORCE_MODE)
+/* Mac EEE control registers */
+#define MTK_MAC_EEE(x) (0x10104 + (x * 0x100))
+#define MAC_EEE_WAKEUP_TIME_1000 GENMASK(31, 24)
+#define MAC_EEE_WAKEUP_TIME_100 GENMASK(23, 16)
+#define MAC_EEE_LPI_TXIDLE_THD GENMASK(15, 8)
+#define MAC_EEE_RESV0 GENMASK(7, 4)
+#define MAC_EEE_CKG_TXILDE BIT(3)
+#define MAC_EEE_CKG_RXLPI BIT(2)
+#define MAC_EEE_TX_DOWN_REQ BIT(1)
+#define MAC_EEE_LPI_MODE BIT(0)
+
/* Mac status registers */
#define MTK_MAC_MSR(x) (0x10108 + (x * 0x100))
#define MAC_MSR_EEE1G BIT(7)
@@ -455,6 +490,12 @@
#define INTF_MODE_RGMII_1000 (TRGMII_MODE | TRGMII_CENTRAL_ALIGNED)
#define INTF_MODE_RGMII_10_100 0
+/* XFI Mac control registers */
+#define MTK_XMAC_MCR(x) (0x12000 + ((x - 1) * 0x1000))
+#define XMAC_MCR_TRX_DISABLE 0xf
+#define XMAC_MCR_FORCE_TX_FC BIT(5)
+#define XMAC_MCR_FORCE_RX_FC BIT(4)
+
/* GPIO port control registers for GMAC 2*/
#define GPIO_OD33_CTRL8 0x4c0
#define GPIO_BIAS_CTRL 0xed0
@@ -480,6 +521,7 @@
#define SYSCFG0_SGMII_GMAC2 ((3 << 8) & SYSCFG0_SGMII_MASK)
#define SYSCFG0_SGMII_GMAC1_V2 BIT(9)
#define SYSCFG0_SGMII_GMAC2_V2 BIT(8)
+#define SYSCFG0_SGMII_GMAC3_V2 BIT(7)
/* ethernet subsystem clock register */
@@ -506,16 +548,69 @@
#define ETHSYS_DMA_AG_MAP_QDMA BIT(1)
#define ETHSYS_DMA_AG_MAP_PPE BIT(2)
+/* USXGMII subsystem config registers */
+/* Register to control speed */
+#define RG_PHY_TOP_SPEED_CTRL1 0x80C
+#define RG_USXGMII_RATE_UPDATE_MODE BIT(31)
+#define RG_MAC_CK_GATED BIT(29)
+#define RG_IF_FORCE_EN BIT(28)
+#define RG_RATE_ADAPT_MODE GENMASK(10, 8)
+#define RG_RATE_ADAPT_MODE_X1 0
+#define RG_RATE_ADAPT_MODE_X2 1
+#define RG_RATE_ADAPT_MODE_X4 2
+#define RG_RATE_ADAPT_MODE_X10 3
+#define RG_RATE_ADAPT_MODE_X100 4
+#define RG_RATE_ADAPT_MODE_X5 5
+#define RG_RATE_ADAPT_MODE_X50 6
+#define RG_XFI_RX_MODE GENMASK(6, 4)
+#define RG_XFI_RX_MODE_10G 0
+#define RG_XFI_RX_MODE_5G 1
+#define RG_XFI_TX_MODE GENMASK(2, 0)
+#define RG_XFI_TX_MODE_10G 0
+#define RG_XFI_TX_MODE_5G 1
+
+/* Register to control PCS AN */
+#define RG_PCS_AN_CTRL0 0x810
+#define RG_AN_ENABLE BIT(0)
+
+/* Register to control USXGMII XFI PLL digital */
+#define XFI_PLL_DIG_GLB8 0x08
+#define RG_XFI_PLL_EN BIT(31)
+
+/* Register to control USXGMII XFI PLL analog */
+#define XFI_PLL_ANA_GLB8 0x108
+#define RG_XFI_PLL_ANA_SWWA 0x02283248
+
/* Infrasys subsystem config registers */
#define INFRA_MISC2 0x70c
#define CO_QPHY_SEL BIT(0)
#define GEPHY_MAC_SEL BIT(1)
+/* Toprgu subsystem config registers */
+#define TOPRGU_SWSYSRST 0x18
+#define SWSYSRST_UNLOCK_KEY GENMASK(31, 24)
+#define SWSYSRST_XFI_PLL_GRST BIT(16)
+#define SWSYSRST_XFI_PEXPT1_GRST BIT(15)
+#define SWSYSRST_XFI_PEXPT0_GRST BIT(14)
+#define SWSYSRST_SGMII1_GRST BIT(2)
+#define SWSYSRST_SGMII0_GRST BIT(1)
+#define TOPRGU_SWSYSRST_EN 0xFC
+
/* Top misc registers */
+#define TOP_MISC_NETSYS_PCS_MUX 0x84
+#define NETSYS_PCS_MUX_MASK GENMASK(1, 0)
+#define MUX_G2_USXGMII_SEL BIT(1)
+#define MUX_HSGMII1_G1_SEL BIT(0)
+
#define USB_PHY_SWITCH_REG 0x218
#define QPHY_SEL_MASK GENMASK(1, 0)
#define SGMII_QPHY_SEL 0x2
+/* MDIO control */
+#define MII_MMD_ACC_CTL_REG 0x0d
+#define MII_MMD_ADDR_DATA_REG 0x0e
+#define MMD_OP_MODE_DATA BIT(14)
+
/* MT7628/88 specific stuff */
#define MT7628_PDMA_OFFSET 0x0800
#define MT7628_SDM_OFFSET 0x0c00
@@ -809,13 +904,6 @@ enum mtk_gmac_id {
MTK_GMAC_ID_MAX
};
-/* GDM Type */
-enum mtk_gdm_type {
- MTK_GDM_TYPE = 0,
- MTK_XGDM_TYPE,
- MTK_GDM_TYPE_MAX
-};
-
enum mtk_tx_buf_type {
MTK_TYPE_SKB,
MTK_TYPE_XDP_TX,
@@ -902,6 +990,7 @@ enum mkt_eth_capabilities {
MTK_TRGMII_BIT,
MTK_SGMII_BIT,
MTK_USXGMII_BIT,
+ MTK_2P5GPHY_BIT,
MTK_ESW_BIT,
MTK_GEPHY_BIT,
MTK_MUX_BIT,
@@ -922,6 +1011,7 @@ enum mkt_eth_capabilities {
MTK_ETH_MUX_GDM1_TO_GMAC1_ESW_BIT,
MTK_ETH_MUX_GMAC2_GMAC0_TO_GEPHY_BIT,
MTK_ETH_MUX_U3_GMAC2_TO_QPHY_BIT,
+ MTK_ETH_MUX_GMAC2_TO_2P5GPHY_BIT,
MTK_ETH_MUX_GMAC1_GMAC2_TO_SGMII_RGMII_BIT,
MTK_ETH_MUX_GMAC12_TO_GEPHY_SGMII_BIT,
MTK_ETH_MUX_GMAC123_TO_GEPHY_SGMII_BIT,
@@ -933,6 +1023,7 @@ enum mkt_eth_capabilities {
MTK_ETH_PATH_GMAC1_SGMII_BIT,
MTK_ETH_PATH_GMAC2_RGMII_BIT,
MTK_ETH_PATH_GMAC2_SGMII_BIT,
+ MTK_ETH_PATH_GMAC2_2P5GPHY_BIT,
MTK_ETH_PATH_GMAC2_GEPHY_BIT,
MTK_ETH_PATH_GMAC3_SGMII_BIT,
MTK_ETH_PATH_GDM1_ESW_BIT,
@@ -946,6 +1037,7 @@ enum mkt_eth_capabilities {
#define MTK_TRGMII BIT_ULL(MTK_TRGMII_BIT)
#define MTK_SGMII BIT_ULL(MTK_SGMII_BIT)
#define MTK_USXGMII BIT_ULL(MTK_USXGMII_BIT)
+#define MTK_2P5GPHY BIT_ULL(MTK_2P5GPHY_BIT)
#define MTK_ESW BIT_ULL(MTK_ESW_BIT)
#define MTK_GEPHY BIT_ULL(MTK_GEPHY_BIT)
#define MTK_MUX BIT_ULL(MTK_MUX_BIT)
@@ -968,6 +1060,8 @@ enum mkt_eth_capabilities {
BIT_ULL(MTK_ETH_MUX_GMAC2_GMAC0_TO_GEPHY_BIT)
#define MTK_ETH_MUX_U3_GMAC2_TO_QPHY \
BIT_ULL(MTK_ETH_MUX_U3_GMAC2_TO_QPHY_BIT)
+#define MTK_ETH_MUX_GMAC2_TO_2P5GPHY \
+ BIT_ULL(MTK_ETH_MUX_GMAC2_TO_2P5GPHY_BIT)
#define MTK_ETH_MUX_GMAC1_GMAC2_TO_SGMII_RGMII \
BIT_ULL(MTK_ETH_MUX_GMAC1_GMAC2_TO_SGMII_RGMII_BIT)
#define MTK_ETH_MUX_GMAC12_TO_GEPHY_SGMII \
@@ -983,6 +1077,7 @@ enum mkt_eth_capabilities {
#define MTK_ETH_PATH_GMAC1_SGMII BIT_ULL(MTK_ETH_PATH_GMAC1_SGMII_BIT)
#define MTK_ETH_PATH_GMAC2_RGMII BIT_ULL(MTK_ETH_PATH_GMAC2_RGMII_BIT)
#define MTK_ETH_PATH_GMAC2_SGMII BIT_ULL(MTK_ETH_PATH_GMAC2_SGMII_BIT)
+#define MTK_ETH_PATH_GMAC2_2P5GPHY BIT_ULL(MTK_ETH_PATH_GMAC2_2P5GPHY_BIT)
#define MTK_ETH_PATH_GMAC2_GEPHY BIT_ULL(MTK_ETH_PATH_GMAC2_GEPHY_BIT)
#define MTK_ETH_PATH_GMAC3_SGMII BIT_ULL(MTK_ETH_PATH_GMAC3_SGMII_BIT)
#define MTK_ETH_PATH_GDM1_ESW BIT_ULL(MTK_ETH_PATH_GDM1_ESW_BIT)
@@ -996,6 +1091,7 @@ enum mkt_eth_capabilities {
#define MTK_GMAC2_RGMII (MTK_ETH_PATH_GMAC2_RGMII | MTK_RGMII)
#define MTK_GMAC2_SGMII (MTK_ETH_PATH_GMAC2_SGMII | MTK_SGMII)
#define MTK_GMAC2_GEPHY (MTK_ETH_PATH_GMAC2_GEPHY | MTK_GEPHY)
+#define MTK_GMAC2_2P5GPHY (MTK_ETH_PATH_GMAC2_2P5GPHY | MTK_2P5GPHY)
#define MTK_GMAC3_SGMII (MTK_ETH_PATH_GMAC3_SGMII | MTK_SGMII)
#define MTK_GDM1_ESW (MTK_ETH_PATH_GDM1_ESW | MTK_ESW)
#define MTK_GMAC1_USXGMII (MTK_ETH_PATH_GMAC1_USXGMII | MTK_USXGMII)
@@ -1019,6 +1115,10 @@ enum mkt_eth_capabilities {
(MTK_ETH_MUX_GMAC1_GMAC2_TO_SGMII_RGMII | MTK_MUX | \
MTK_SHARED_SGMII)
+/* 2: GMAC2 -> XGMII */
+#define MTK_MUX_GMAC2_TO_2P5GPHY \
+ (MTK_ETH_MUX_GMAC2_TO_2P5GPHY | MTK_MUX | MTK_INFRA)
+
/* 0: GMACx -> GEPHY, 1: GMACx -> SGMII where x is 1 or 2 */
#define MTK_MUX_GMAC12_TO_GEPHY_SGMII \
(MTK_ETH_MUX_GMAC12_TO_GEPHY_SGMII | MTK_MUX)
@@ -1077,7 +1177,8 @@ enum mkt_eth_capabilities {
MTK_MUX_GMAC123_TO_GEPHY_SGMII | \
MTK_NETSYS_V3 | MTK_RSTCTRL_PPE1 | \
MTK_GMAC1_USXGMII | MTK_GMAC2_USXGMII | \
- MTK_GMAC3_USXGMII | MTK_MUX_GMAC123_TO_USXGMII)
+ MTK_GMAC3_USXGMII | MTK_MUX_GMAC123_TO_USXGMII | \
+ MTK_GMAC2_2P5GPHY | MTK_MUX_GMAC2_TO_2P5GPHY)
struct mtk_tx_dma_desc_info {
dma_addr_t addr;
@@ -1183,6 +1284,19 @@ struct mtk_soc_data {
#define MTK_DMA_MONITOR_TIMEOUT msecs_to_jiffies(1000)
+/* struct mtk_xgmii - This is the structure holding sgmii/usxgmii regmap and
+ * its characteristics
+ * @regmap: The register map pointing at the range used to setup
+ * SGMII/USXGMII modes
+ * @flags: The enum refers to which mode the sgmii wants to run on
+ * @ana_rgc3: The offset refers to register ANA_RGC3 related to regmap
+ */
+struct mtk_xgmii {
+ struct regmap **regmap_usxgmii;
+ struct regmap **regmap_pextp;
+ struct regmap *regmap_pll;
+};
+
/* struct mtk_eth - This is the main datasructure for holding the state
* of the driver
* @dev: The device pointer
@@ -1244,7 +1358,9 @@ struct mtk_eth {
unsigned long sysclk;
struct regmap *ethsys;
struct regmap *infra;
+ struct regmap *toprgu;
struct phylink_pcs **sgmii_pcs;
+ struct mtk_xgmii *xgmii;
struct regmap *pctl;
bool hwlro;
refcount_t dma_refcnt;
@@ -1400,6 +1516,19 @@ static inline u32 mtk_get_ib2_multicast_
return MTK_FOE_IB2_MULTICAST;
}
+static inline bool mtk_interface_mode_is_xgmii(phy_interface_t interface)
+{
+ switch (interface) {
+ case PHY_INTERFACE_MODE_USXGMII:
+ case PHY_INTERFACE_MODE_10GKR:
+ case PHY_INTERFACE_MODE_5GBASER:
+ return true;
+ break;
+ default:
+ return false;
+ }
+}
+
/* read the hardware status register */
void mtk_stats_update_mac(struct mtk_mac *mac);
@@ -1407,8 +1536,10 @@ void mtk_w32(struct mtk_eth *eth, u32 va
u32 mtk_r32(struct mtk_eth *eth, unsigned reg);
int mtk_gmac_sgmii_path_setup(struct mtk_eth *eth, int mac_id);
+int mtk_gmac_2p5gphy_path_setup(struct mtk_eth *eth, int mac_id);
int mtk_gmac_gephy_path_setup(struct mtk_eth *eth, int mac_id);
int mtk_gmac_rgmii_path_setup(struct mtk_eth *eth, int mac_id);
+int mtk_gmac_usxgmii_path_setup(struct mtk_eth *eth, int mac_id);
int mtk_eth_offload_init(struct mtk_eth *eth);
int mtk_eth_setup_tc(struct net_device *dev, enum tc_setup_type type,
@@ -1418,5 +1549,36 @@ int mtk_flow_offload_cmd(struct mtk_eth
void mtk_flow_offload_cleanup(struct mtk_eth *eth, struct list_head *list);
void mtk_eth_set_dma_device(struct mtk_eth *eth, struct device *dma_dev);
+#ifdef CONFIG_NET_MEDIATEK_SOC_USXGMII
+int mtk_usxgmii_init(struct mtk_eth *eth);
+int mtk_xfi_pextp_init(struct mtk_eth *eth);
+int mtk_xfi_pll_init(struct mtk_eth *eth);
+int mtk_toprgu_init(struct mtk_eth *eth);
+int mtk_xfi_pll_enable(struct mtk_eth *eth);
+int mtk_usxgmii_setup_mode_an(struct mtk_eth *eth, int mac_id,
+ int max_speed);
+int mtk_usxgmii_setup_mode_force(struct mtk_eth *eth, int mac_id,
+ const struct phylink_link_state *state);
+void mtk_usxgmii_setup_phya_an_10000(struct mtk_eth *eth, int mac_id);
+void mtk_usxgmii_reset(struct mtk_eth *eth, int mac_id);
+void mtk_sgmii_setup_phya_gen1(struct mtk_eth *eth, int mac_id);
+void mtk_sgmii_setup_phya_gen2(struct mtk_eth *eth, int mac_id);
+void mtk_sgmii_reset(struct mtk_eth *eth, int mac_id);
+#else
+static inline int mtk_usxgmii_init(struct mtk_eth *eth) { return 0; };
+static inline int mtk_xfi_pextp_init(struct mtk_eth *eth) { return 0; };
+static inline int mtk_xfi_pll_init(struct mtk_eth *eth) { return 0; };
+static inline int mtk_toprgu_init(struct mtk_eth *eth) { return 0; };
+static inline int mtk_xfi_pll_enable(struct mtk_eth *eth) { return 0; };
+static inline int mtk_usxgmii_setup_mode_an(struct mtk_eth *eth, int mac_id,
+ int max_speed) { return 0; };
+static inline int mtk_usxgmii_setup_mode_force(struct mtk_eth *eth, int mac_id,
+ const struct phylink_link_state *state) { return 0; };
+static inline void mtk_usxgmii_setup_phya_an_10000(struct mtk_eth *eth, int mac_id) { };
+static inline void mtk_usxgmii_reset(struct mtk_eth *eth, int mac_id) { };
+static inline void mtk_sgmii_setup_phya_gen1(struct mtk_eth *eth, int mac_id) { };
+static inline void mtk_sgmii_setup_phya_gen2(struct mtk_eth *eth, int mac_id) { };
+static inline void mtk_sgmii_reset(struct mtk_eth *eth, int mac_id) { };
+#endif
#endif /* MTK_ETH_H */
--- /dev/null
+++ b/drivers/net/ethernet/mediatek/mtk_usxgmii.c
@@ -0,0 +1,646 @@
+/* SPDX-License-Identifier: GPL-2.0
+ *
+ * Copyright (c) 2022 MediaTek Inc.
+ * Author: Henry Yen <henry.yen@mediatek.com>
+ */
+
+#include <linux/mfd/syscon.h>
+#include <linux/of.h>
+#include <linux/regmap.h>
+#include "mtk_eth_soc.h"
+
+int mtk_usxgmii_init(struct mtk_eth *eth)
+{
+ struct device_node *r = eth->dev->of_node;
+ struct mtk_xgmii *xs = eth->xgmii;
+ struct device *dev = eth->dev;
+ struct device_node *np;
+ int i;
+
+ xs->regmap_usxgmii = devm_kzalloc(dev, sizeof(*xs->regmap_usxgmii) *
+ eth->soc->num_devs, GFP_KERNEL);
+ if (!xs->regmap_usxgmii)
+ return -ENOMEM;
+
+ for (i = 0; i < eth->soc->num_devs; i++) {
+ np = of_parse_phandle(r, "mediatek,usxgmiisys", i);
+ if (!np)
+ break;
+
+ xs->regmap_usxgmii[i] = syscon_node_to_regmap(np);
+ if (IS_ERR(xs->regmap_usxgmii[i]))
+ return PTR_ERR(xs->regmap_usxgmii[i]);
+ }
+
+ return 0;
+}
+
+int mtk_xfi_pextp_init(struct mtk_eth *eth)
+{
+ struct device *dev = eth->dev;
+ struct device_node *r = dev->of_node;
+ struct mtk_xgmii *xs = eth->xgmii;
+ struct device_node *np;
+ int i;
+
+ xs->regmap_pextp = devm_kzalloc(dev, sizeof(*xs->regmap_pextp) *
+ eth->soc->num_devs, GFP_KERNEL);
+ if (!xs->regmap_pextp)
+ return -ENOMEM;
+
+ for (i = 0; i < eth->soc->num_devs; i++) {
+ np = of_parse_phandle(r, "mediatek,xfi_pextp", i);
+ if (!np)
+ break;
+
+ xs->regmap_pextp[i] = syscon_node_to_regmap(np);
+ if (IS_ERR(xs->regmap_pextp[i]))
+ return PTR_ERR(xs->regmap_pextp[i]);
+ }
+
+ return 0;
+}
+
+int mtk_xfi_pll_init(struct mtk_eth *eth)
+{
+ struct device_node *r = eth->dev->of_node;
+ struct mtk_xgmii *xs = eth->xgmii;
+ struct device_node *np;
+
+ np = of_parse_phandle(r, "mediatek,xfi_pll", 0);
+ if (!np)
+ return -1;
+
+ xs->regmap_pll = syscon_node_to_regmap(np);
+ if (IS_ERR(xs->regmap_pll))
+ return PTR_ERR(xs->regmap_pll);
+
+ return 0;
+}
+
+int mtk_toprgu_init(struct mtk_eth *eth)
+{
+ struct device_node *r = eth->dev->of_node;
+ struct device_node *np;
+
+ np = of_parse_phandle(r, "mediatek,toprgu", 0);
+ if (!np)
+ return -1;
+
+ eth->toprgu = syscon_node_to_regmap(np);
+ if (IS_ERR(eth->toprgu))
+ return PTR_ERR(eth->toprgu);
+
+ return 0;
+}
+
+int mtk_xfi_pll_enable(struct mtk_eth *eth)
+{
+ struct mtk_xgmii *xs = eth->xgmii;
+ u32 val = 0;
+
+ if (!xs->regmap_pll)
+ return -EINVAL;
+
+ /* Add software workaround for USXGMII PLL TCL issue */
+ regmap_write(xs->regmap_pll, XFI_PLL_ANA_GLB8, RG_XFI_PLL_ANA_SWWA);
+
+ regmap_read(xs->regmap_pll, XFI_PLL_DIG_GLB8, &val);
+ val |= RG_XFI_PLL_EN;
+ regmap_write(xs->regmap_pll, XFI_PLL_DIG_GLB8, val);
+
+ return 0;
+}
+
+static int mtk_mac2xgmii_id(struct mtk_eth *eth, int mac_id)
+{
+ int xgmii_id = mac_id;
+
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V3)) {
+ switch (mac_id) {
+ case MTK_GMAC1_ID:
+ case MTK_GMAC2_ID:
+ xgmii_id = 1;
+ break;
+ case MTK_GMAC3_ID:
+ xgmii_id = 0;
+ break;
+ default:
+ xgmii_id = -1;
+ }
+ }
+
+ return xgmii_id;
+}
+
+void mtk_usxgmii_setup_phya_an_10000(struct mtk_eth *eth, int mac_id)
+{
+ struct mtk_xgmii *xs = eth->xgmii;
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+
+ if (id >= eth->soc->num_devs ||
+ !xs->regmap_usxgmii[id] || !xs->regmap_pextp[id])
+ return;
+
+ regmap_write(xs->regmap_usxgmii[id], RG_PCS_AN_CTRL0, 0x000FFE6D);
+ regmap_write(xs->regmap_usxgmii[id], 0x818, 0x07B1EC7B);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, 0x30000000);
+ ndelay(1020);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, 0x10000000);
+ ndelay(1020);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, 0x00000000);
+
+ regmap_write(xs->regmap_pextp[id], 0x9024, 0x00C9071C);
+ regmap_write(xs->regmap_pextp[id], 0x2020, 0xAA8585AA);
+ regmap_write(xs->regmap_pextp[id], 0x2030, 0x0C020707);
+ regmap_write(xs->regmap_pextp[id], 0x2034, 0x0E050F0F);
+ regmap_write(xs->regmap_pextp[id], 0x2040, 0x00140032);
+ regmap_write(xs->regmap_pextp[id], 0x50F0, 0x00C014AA);
+ regmap_write(xs->regmap_pextp[id], 0x50E0, 0x3777C12B);
+ regmap_write(xs->regmap_pextp[id], 0x506C, 0x005F9CFF);
+ regmap_write(xs->regmap_pextp[id], 0x5070, 0x9D9DFAFA);
+ regmap_write(xs->regmap_pextp[id], 0x5074, 0x27273F3F);
+ regmap_write(xs->regmap_pextp[id], 0x5078, 0xA7883C68);
+ regmap_write(xs->regmap_pextp[id], 0x507C, 0x11661166);
+ regmap_write(xs->regmap_pextp[id], 0x5080, 0x0E000AAF);
+ regmap_write(xs->regmap_pextp[id], 0x5084, 0x08080D0D);
+ regmap_write(xs->regmap_pextp[id], 0x5088, 0x02030909);
+ regmap_write(xs->regmap_pextp[id], 0x50E4, 0x0C0C0000);
+ regmap_write(xs->regmap_pextp[id], 0x50E8, 0x04040000);
+ regmap_write(xs->regmap_pextp[id], 0x50EC, 0x0F0F0C06);
+ regmap_write(xs->regmap_pextp[id], 0x50A8, 0x506E8C8C);
+ regmap_write(xs->regmap_pextp[id], 0x6004, 0x18190000);
+ regmap_write(xs->regmap_pextp[id], 0x00F8, 0x01423342);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F20);
+ regmap_write(xs->regmap_pextp[id], 0x0030, 0x00050C00);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x02002800);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000020);
+ regmap_write(xs->regmap_pextp[id], 0x3028, 0x00008A01);
+ regmap_write(xs->regmap_pextp[id], 0x302C, 0x0000A884);
+ regmap_write(xs->regmap_pextp[id], 0x3024, 0x00083002);
+ regmap_write(xs->regmap_pextp[id], 0x3010, 0x00022220);
+ regmap_write(xs->regmap_pextp[id], 0x5064, 0x0F020A01);
+ regmap_write(xs->regmap_pextp[id], 0x50B4, 0x06100600);
+ regmap_write(xs->regmap_pextp[id], 0x3048, 0x40704000);
+ regmap_write(xs->regmap_pextp[id], 0x3050, 0xA8000000);
+ regmap_write(xs->regmap_pextp[id], 0x3054, 0x000000AA);
+ regmap_write(xs->regmap_pextp[id], 0x306C, 0x00000F00);
+ regmap_write(xs->regmap_pextp[id], 0xA060, 0x00040000);
+ regmap_write(xs->regmap_pextp[id], 0x90D0, 0x00000001);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200E800);
+ udelay(150);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C101);
+ udelay(15);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0202C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0202C101);
+ udelay(100);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000030);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F00);
+ regmap_write(xs->regmap_pextp[id], 0x3040, 0x30000000);
+ udelay(400);
+}
+
+void mtk_usxgmii_setup_phya_force_5000(struct mtk_eth *eth, int mac_id)
+{
+ unsigned int val;
+ struct mtk_xgmii *xs = eth->xgmii;
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+
+ if (id >= eth->soc->num_devs ||
+ !xs->regmap_usxgmii[id] || !xs->regmap_pextp[id])
+ return;
+
+ /* Setup USXGMII speed */
+ val = FIELD_PREP(RG_XFI_RX_MODE, RG_XFI_RX_MODE_5G) |
+ FIELD_PREP(RG_XFI_TX_MODE, RG_XFI_TX_MODE_5G);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ /* Disable USXGMII AN mode */
+ regmap_read(xs->regmap_usxgmii[id], RG_PCS_AN_CTRL0, &val);
+ val &= ~RG_AN_ENABLE;
+ regmap_write(xs->regmap_usxgmii[id], RG_PCS_AN_CTRL0, val);
+
+ /* Gated USXGMII */
+ regmap_read(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, &val);
+ val |= RG_MAC_CK_GATED;
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ ndelay(1020);
+
+ /* USXGMII force mode setting */
+ regmap_read(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, &val);
+ val |= RG_USXGMII_RATE_UPDATE_MODE;
+ val |= RG_IF_FORCE_EN;
+ val |= FIELD_PREP(RG_RATE_ADAPT_MODE, RG_RATE_ADAPT_MODE_X1);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ /* Un-gated USXGMII */
+ regmap_read(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, &val);
+ val &= ~RG_MAC_CK_GATED;
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ ndelay(1020);
+
+ regmap_write(xs->regmap_pextp[id], 0x9024, 0x00D9071C);
+ regmap_write(xs->regmap_pextp[id], 0x2020, 0xAAA5A5AA);
+ regmap_write(xs->regmap_pextp[id], 0x2030, 0x0C020707);
+ regmap_write(xs->regmap_pextp[id], 0x2034, 0x0E050F0F);
+ regmap_write(xs->regmap_pextp[id], 0x2040, 0x00140032);
+ regmap_write(xs->regmap_pextp[id], 0x50F0, 0x00C018AA);
+ regmap_write(xs->regmap_pextp[id], 0x50E0, 0x3777812B);
+ regmap_write(xs->regmap_pextp[id], 0x506C, 0x005C9CFF);
+ regmap_write(xs->regmap_pextp[id], 0x5070, 0x9DFAFAFA);
+ regmap_write(xs->regmap_pextp[id], 0x5074, 0x273F3F3F);
+ regmap_write(xs->regmap_pextp[id], 0x5078, 0xA8883868);
+ regmap_write(xs->regmap_pextp[id], 0x507C, 0x14661466);
+ regmap_write(xs->regmap_pextp[id], 0x5080, 0x0E001ABF);
+ regmap_write(xs->regmap_pextp[id], 0x5084, 0x080B0D0D);
+ regmap_write(xs->regmap_pextp[id], 0x5088, 0x02050909);
+ regmap_write(xs->regmap_pextp[id], 0x50E4, 0x0C000000);
+ regmap_write(xs->regmap_pextp[id], 0x50E8, 0x04000000);
+ regmap_write(xs->regmap_pextp[id], 0x50EC, 0x0F0F0C06);
+ regmap_write(xs->regmap_pextp[id], 0x50A8, 0x50808C8C);
+ regmap_write(xs->regmap_pextp[id], 0x6004, 0x18000000);
+ regmap_write(xs->regmap_pextp[id], 0x00F8, 0x00A132A1);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F20);
+ regmap_write(xs->regmap_pextp[id], 0x0030, 0x00050C00);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x02002800);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000020);
+ regmap_write(xs->regmap_pextp[id], 0x3028, 0x00008A01);
+ regmap_write(xs->regmap_pextp[id], 0x302C, 0x0000A884);
+ regmap_write(xs->regmap_pextp[id], 0x3024, 0x00083002);
+ regmap_write(xs->regmap_pextp[id], 0x3010, 0x00022220);
+ regmap_write(xs->regmap_pextp[id], 0x5064, 0x0F020A01);
+ regmap_write(xs->regmap_pextp[id], 0x50B4, 0x06100600);
+ regmap_write(xs->regmap_pextp[id], 0x3048, 0x40704000);
+ regmap_write(xs->regmap_pextp[id], 0x3050, 0xA8000000);
+ regmap_write(xs->regmap_pextp[id], 0x3054, 0x000000AA);
+ regmap_write(xs->regmap_pextp[id], 0x306C, 0x00000F00);
+ regmap_write(xs->regmap_pextp[id], 0xA060, 0x00040000);
+ regmap_write(xs->regmap_pextp[id], 0x90D0, 0x00000003);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200E800);
+ udelay(150);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C101);
+ udelay(15);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0202C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0202C101);
+ udelay(100);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000030);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F00);
+ regmap_write(xs->regmap_pextp[id], 0x3040, 0x30000000);
+ udelay(400);
+}
+
+void mtk_usxgmii_setup_phya_force_10000(struct mtk_eth *eth, int mac_id)
+{
+ struct mtk_xgmii *xs = eth->xgmii;
+ unsigned int val;
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+
+ if (id >= eth->soc->num_devs ||
+ !xs->regmap_usxgmii[id] || !xs->regmap_pextp[id])
+ return;
+
+ /* Setup USXGMII speed */
+ val = FIELD_PREP(RG_XFI_RX_MODE, RG_XFI_RX_MODE_10G) |
+ FIELD_PREP(RG_XFI_TX_MODE, RG_XFI_TX_MODE_10G);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ /* Disable USXGMII AN mode */
+ regmap_read(xs->regmap_usxgmii[id], RG_PCS_AN_CTRL0, &val);
+ val &= ~RG_AN_ENABLE;
+ regmap_write(xs->regmap_usxgmii[id], RG_PCS_AN_CTRL0, val);
+
+ /* Gated USXGMII */
+ regmap_read(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, &val);
+ val |= RG_MAC_CK_GATED;
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ ndelay(1020);
+
+ /* USXGMII force mode setting */
+ regmap_read(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, &val);
+ val |= RG_USXGMII_RATE_UPDATE_MODE;
+ val |= RG_IF_FORCE_EN;
+ val |= FIELD_PREP(RG_RATE_ADAPT_MODE, RG_RATE_ADAPT_MODE_X1);
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ /* Un-gated USXGMII */
+ regmap_read(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, &val);
+ val &= ~RG_MAC_CK_GATED;
+ regmap_write(xs->regmap_usxgmii[id], RG_PHY_TOP_SPEED_CTRL1, val);
+
+ ndelay(1020);
+
+ regmap_write(xs->regmap_pextp[id], 0x9024, 0x00C9071C);
+ regmap_write(xs->regmap_pextp[id], 0x2020, 0xAA8585AA);
+ regmap_write(xs->regmap_pextp[id], 0x2030, 0x0C020707);
+ regmap_write(xs->regmap_pextp[id], 0x2034, 0x0E050F0F);
+ regmap_write(xs->regmap_pextp[id], 0x2040, 0x00140032);
+ regmap_write(xs->regmap_pextp[id], 0x50F0, 0x00C014AA);
+ regmap_write(xs->regmap_pextp[id], 0x50E0, 0x3777C12B);
+ regmap_write(xs->regmap_pextp[id], 0x506C, 0x005F9CFF);
+ regmap_write(xs->regmap_pextp[id], 0x5070, 0x9D9DFAFA);
+ regmap_write(xs->regmap_pextp[id], 0x5074, 0x27273F3F);
+ regmap_write(xs->regmap_pextp[id], 0x5078, 0xA7883C68);
+ regmap_write(xs->regmap_pextp[id], 0x507C, 0x11661166);
+ regmap_write(xs->regmap_pextp[id], 0x5080, 0x0E000AAF);
+ regmap_write(xs->regmap_pextp[id], 0x5084, 0x08080D0D);
+ regmap_write(xs->regmap_pextp[id], 0x5088, 0x02030909);
+ regmap_write(xs->regmap_pextp[id], 0x50E4, 0x0C0C0000);
+ regmap_write(xs->regmap_pextp[id], 0x50E8, 0x04040000);
+ regmap_write(xs->regmap_pextp[id], 0x50EC, 0x0F0F0C06);
+ regmap_write(xs->regmap_pextp[id], 0x50A8, 0x506E8C8C);
+ regmap_write(xs->regmap_pextp[id], 0x6004, 0x18190000);
+ regmap_write(xs->regmap_pextp[id], 0x00F8, 0x01423342);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F20);
+ regmap_write(xs->regmap_pextp[id], 0x0030, 0x00050C00);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x02002800);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000020);
+ regmap_write(xs->regmap_pextp[id], 0x3028, 0x00008A01);
+ regmap_write(xs->regmap_pextp[id], 0x302C, 0x0000A884);
+ regmap_write(xs->regmap_pextp[id], 0x3024, 0x00083002);
+ regmap_write(xs->regmap_pextp[id], 0x3010, 0x00022220);
+ regmap_write(xs->regmap_pextp[id], 0x5064, 0x0F020A01);
+ regmap_write(xs->regmap_pextp[id], 0x50B4, 0x06100600);
+ regmap_write(xs->regmap_pextp[id], 0x3048, 0x49664100);
+ regmap_write(xs->regmap_pextp[id], 0x3050, 0x00000000);
+ regmap_write(xs->regmap_pextp[id], 0x3054, 0x00000000);
+ regmap_write(xs->regmap_pextp[id], 0x306C, 0x00000F00);
+ regmap_write(xs->regmap_pextp[id], 0xA060, 0x00040000);
+ regmap_write(xs->regmap_pextp[id], 0x90D0, 0x00000001);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200E800);
+ udelay(150);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C101);
+ udelay(15);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0202C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0202C101);
+ udelay(100);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000030);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F00);
+ regmap_write(xs->regmap_pextp[id], 0x3040, 0x30000000);
+ udelay(400);
+}
+
+void mtk_usxgmii_reset(struct mtk_eth *eth, int mac_id)
+{
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+
+ if (id >= eth->soc->num_devs || !eth->toprgu)
+ return;
+
+ switch (mac_id) {
+ case MTK_GMAC2_ID:
+ regmap_write(eth->toprgu, 0xFC, 0x0000A004);
+ regmap_write(eth->toprgu, 0x18, 0x88F0A004);
+ regmap_write(eth->toprgu, 0xFC, 0x00000000);
+ regmap_write(eth->toprgu, 0x18, 0x88F00000);
+ regmap_write(eth->toprgu, 0x18, 0x00F00000);
+ break;
+ case MTK_GMAC3_ID:
+ regmap_write(eth->toprgu, 0xFC, 0x00005002);
+ regmap_write(eth->toprgu, 0x18, 0x88F05002);
+ regmap_write(eth->toprgu, 0xFC, 0x00000000);
+ regmap_write(eth->toprgu, 0x18, 0x88F00000);
+ regmap_write(eth->toprgu, 0x18, 0x00F00000);
+ break;
+ }
+
+ mdelay(10);
+}
+
+int mtk_usxgmii_setup_mode_an(struct mtk_eth *eth, int mac_id, int max_speed)
+{
+ if (mac_id < 0 || mac_id >= eth->soc->num_devs)
+ return -EINVAL;
+
+ if ((max_speed != SPEED_10000) && (max_speed != SPEED_5000))
+ return -EINVAL;
+
+ mtk_xfi_pll_enable(eth);
+ mtk_usxgmii_reset(eth, mac_id);
+ mtk_usxgmii_setup_phya_an_10000(eth, mac_id);
+
+ return 0;
+}
+
+int mtk_usxgmii_setup_mode_force(struct mtk_eth *eth, int mac_id,
+ const struct phylink_link_state *state)
+{
+ if (mac_id < 0 || mac_id >= eth->soc->num_devs)
+ return -EINVAL;
+
+ mtk_xfi_pll_enable(eth);
+ mtk_usxgmii_reset(eth, mac_id);
+ if (state->interface == PHY_INTERFACE_MODE_5GBASER)
+ mtk_usxgmii_setup_phya_force_5000(eth, mac_id);
+ else
+ mtk_usxgmii_setup_phya_force_10000(eth, mac_id);
+
+ return 0;
+}
+
+void mtk_sgmii_setup_phya_gen1(struct mtk_eth *eth, int mac_id)
+{
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+ struct mtk_xgmii *xs = eth->xgmii;
+
+ if (id >= eth->soc->num_devs || !xs->regmap_pextp[id])
+ return;
+
+ regmap_write(xs->regmap_pextp[id], 0x9024, 0x00D9071C);
+ regmap_write(xs->regmap_pextp[id], 0x2020, 0xAA8585AA);
+ regmap_write(xs->regmap_pextp[id], 0x2030, 0x0C020207);
+ regmap_write(xs->regmap_pextp[id], 0x2034, 0x0E05050F);
+ regmap_write(xs->regmap_pextp[id], 0x2040, 0x00200032);
+ regmap_write(xs->regmap_pextp[id], 0x50F0, 0x00C014BA);
+ regmap_write(xs->regmap_pextp[id], 0x50E0, 0x3777C12B);
+ regmap_write(xs->regmap_pextp[id], 0x506C, 0x005F9CFF);
+ regmap_write(xs->regmap_pextp[id], 0x5070, 0x9D9DFAFA);
+ regmap_write(xs->regmap_pextp[id], 0x5074, 0x27273F3F);
+ regmap_write(xs->regmap_pextp[id], 0x5078, 0xA7883C68);
+ regmap_write(xs->regmap_pextp[id], 0x507C, 0x11661166);
+ regmap_write(xs->regmap_pextp[id], 0x5080, 0x0E000EAF);
+ regmap_write(xs->regmap_pextp[id], 0x5084, 0x08080E0D);
+ regmap_write(xs->regmap_pextp[id], 0x5088, 0x02030B09);
+ regmap_write(xs->regmap_pextp[id], 0x50E4, 0x0C0C0000);
+ regmap_write(xs->regmap_pextp[id], 0x50E8, 0x04040000);
+ regmap_write(xs->regmap_pextp[id], 0x50EC, 0x0F0F0606);
+ regmap_write(xs->regmap_pextp[id], 0x50A8, 0x506E8C8C);
+ regmap_write(xs->regmap_pextp[id], 0x6004, 0x18190000);
+ regmap_write(xs->regmap_pextp[id], 0x00F8, 0x00FA32FA);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F21);
+ regmap_write(xs->regmap_pextp[id], 0x0030, 0x00050C00);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x02002800);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000020);
+ regmap_write(xs->regmap_pextp[id], 0x3028, 0x00008A01);
+ regmap_write(xs->regmap_pextp[id], 0x302C, 0x0000A884);
+ regmap_write(xs->regmap_pextp[id], 0x3024, 0x00083002);
+ regmap_write(xs->regmap_pextp[id], 0x3010, 0x00011110);
+ regmap_write(xs->regmap_pextp[id], 0x3048, 0x40704000);
+ regmap_write(xs->regmap_pextp[id], 0x3064, 0x0000C000);
+ regmap_write(xs->regmap_pextp[id], 0x3050, 0xA8000000);
+ regmap_write(xs->regmap_pextp[id], 0x3054, 0x000000AA);
+ regmap_write(xs->regmap_pextp[id], 0x306C, 0x20200F00);
+ regmap_write(xs->regmap_pextp[id], 0xA060, 0x00050000);
+ regmap_write(xs->regmap_pextp[id], 0x90D0, 0x00000007);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200E800);
+ udelay(150);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C101);
+ udelay(15);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0201C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0201C101);
+ udelay(100);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000030);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F01);
+ regmap_write(xs->regmap_pextp[id], 0x3040, 0x30000000);
+ udelay(400);
+}
+
+void mtk_sgmii_setup_phya_gen2(struct mtk_eth *eth, int mac_id)
+{
+ struct mtk_xgmii *xs = eth->xgmii;
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+
+ if (id >= eth->soc->num_devs || !xs->regmap_pextp[id])
+ return;
+
+ regmap_write(xs->regmap_pextp[id], 0x9024, 0x00D9071C);
+ regmap_write(xs->regmap_pextp[id], 0x2020, 0xAA8585AA);
+ regmap_write(xs->regmap_pextp[id], 0x2030, 0x0C020707);
+ regmap_write(xs->regmap_pextp[id], 0x2034, 0x0E050F0F);
+ regmap_write(xs->regmap_pextp[id], 0x2040, 0x00140032);
+ regmap_write(xs->regmap_pextp[id], 0x50F0, 0x00C014AA);
+ regmap_write(xs->regmap_pextp[id], 0x50E0, 0x3777C12B);
+ regmap_write(xs->regmap_pextp[id], 0x506C, 0x005F9CFF);
+ regmap_write(xs->regmap_pextp[id], 0x5070, 0x9D9DFAFA);
+ regmap_write(xs->regmap_pextp[id], 0x5074, 0x27273F3F);
+ regmap_write(xs->regmap_pextp[id], 0x5078, 0xA7883C68);
+ regmap_write(xs->regmap_pextp[id], 0x507C, 0x11661166);
+ regmap_write(xs->regmap_pextp[id], 0x5080, 0x0E000AAF);
+ regmap_write(xs->regmap_pextp[id], 0x5084, 0x08080D0D);
+ regmap_write(xs->regmap_pextp[id], 0x5088, 0x02030909);
+ regmap_write(xs->regmap_pextp[id], 0x50E4, 0x0C0C0000);
+ regmap_write(xs->regmap_pextp[id], 0x50E8, 0x04040000);
+ regmap_write(xs->regmap_pextp[id], 0x50EC, 0x0F0F0C06);
+ regmap_write(xs->regmap_pextp[id], 0x50A8, 0x506E8C8C);
+ regmap_write(xs->regmap_pextp[id], 0x6004, 0x18190000);
+ regmap_write(xs->regmap_pextp[id], 0x00F8, 0x009C329C);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F21);
+ regmap_write(xs->regmap_pextp[id], 0x0030, 0x00050C00);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x02002800);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000020);
+ regmap_write(xs->regmap_pextp[id], 0x3028, 0x00008A01);
+ regmap_write(xs->regmap_pextp[id], 0x302C, 0x0000A884);
+ regmap_write(xs->regmap_pextp[id], 0x3024, 0x00083002);
+ regmap_write(xs->regmap_pextp[id], 0x3010, 0x00011110);
+ regmap_write(xs->regmap_pextp[id], 0x3048, 0x40704000);
+ regmap_write(xs->regmap_pextp[id], 0x3050, 0xA8000000);
+ regmap_write(xs->regmap_pextp[id], 0x3054, 0x000000AA);
+ regmap_write(xs->regmap_pextp[id], 0x306C, 0x22000F00);
+ regmap_write(xs->regmap_pextp[id], 0xA060, 0x00050000);
+ regmap_write(xs->regmap_pextp[id], 0x90D0, 0x00000005);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200E800);
+ udelay(150);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0200C101);
+ udelay(15);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0201C111);
+ ndelay(1020);
+ regmap_write(xs->regmap_pextp[id], 0x0070, 0x0201C101);
+ udelay(100);
+ regmap_write(xs->regmap_pextp[id], 0x30B0, 0x00000030);
+ regmap_write(xs->regmap_pextp[id], 0x00F4, 0x80201F01);
+ regmap_write(xs->regmap_pextp[id], 0x3040, 0x30000000);
+ udelay(400);
+}
+
+void mtk_sgmii_reset(struct mtk_eth *eth, int mac_id)
+{
+ u32 id = mtk_mac2xgmii_id(eth, mac_id);
+ u32 val = 0;
+
+ if (id >= eth->soc->num_devs || !eth->toprgu)
+ return;
+
+ switch (mac_id) {
+ case MTK_GMAC2_ID:
+ /* Enable software reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST_EN, &val);
+ val |= SWSYSRST_XFI_PEXPT1_GRST |
+ SWSYSRST_SGMII1_GRST;
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST_EN, val);
+
+ /* Assert SGMII reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST, &val);
+ val |= FIELD_PREP(SWSYSRST_UNLOCK_KEY, 0x88) |
+ SWSYSRST_XFI_PEXPT1_GRST |
+ SWSYSRST_SGMII1_GRST;
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST, val);
+
+ udelay(100);
+
+ /* De-assert SGMII reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST, &val);
+ val |= FIELD_PREP(SWSYSRST_UNLOCK_KEY, 0x88);
+ val &= ~(SWSYSRST_XFI_PEXPT1_GRST |
+ SWSYSRST_SGMII1_GRST);
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST, val);
+
+ /* Disable software reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST_EN, &val);
+ val &= ~(SWSYSRST_XFI_PEXPT1_GRST |
+ SWSYSRST_SGMII1_GRST);
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST_EN, val);
+ break;
+ case MTK_GMAC3_ID:
+ /* Enable Software reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST_EN, &val);
+ val |= SWSYSRST_XFI_PEXPT0_GRST |
+ SWSYSRST_SGMII0_GRST;
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST_EN, val);
+
+ /* Assert SGMII reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST, &val);
+ val |= FIELD_PREP(SWSYSRST_UNLOCK_KEY, 0x88) |
+ SWSYSRST_XFI_PEXPT0_GRST |
+ SWSYSRST_SGMII0_GRST;
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST, val);
+
+ udelay(100);
+
+ /* De-assert SGMII reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST, &val);
+ val |= FIELD_PREP(SWSYSRST_UNLOCK_KEY, 0x88);
+ val &= ~(SWSYSRST_XFI_PEXPT0_GRST |
+ SWSYSRST_SGMII0_GRST);
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST, val);
+
+ /* Disable software reset */
+ regmap_read(eth->toprgu, TOPRGU_SWSYSRST_EN, &val);
+ val &= ~(SWSYSRST_XFI_PEXPT0_GRST |
+ SWSYSRST_SGMII0_GRST);
+ regmap_write(eth->toprgu, TOPRGU_SWSYSRST_EN, val);
+ break;
+ }
+
+ mdelay(1);
+}
--- a/drivers/net/ethernet/mediatek/Kconfig
+++ b/drivers/net/ethernet/mediatek/Kconfig
@@ -11,6 +11,14 @@ config NET_MEDIATEK_SOC_WED
depends on ARCH_MEDIATEK || COMPILE_TEST
def_bool NET_MEDIATEK_SOC != n
+config NET_MEDIATEK_SOC_USXGMII
+ bool "Support USXGMII SerDes on MT7988"
+ depends on (ARCH_MEDIATEK && ARM64) || COMPILE_TEST
+ def_bool NET_MEDIATEK_SOC != n
+ help
+ Include support for 10G USXGMII SerDes unit which can
+ be found on MT7988.
+
config NET_MEDIATEK_SOC
tristate "MediaTek SoC Gigabit Ethernet support"
depends on NET_DSA || !NET_DSA
Reference in New Issue Copy Permalink