net: jr2: Fix Serdes6G configuration

Sometimes no traffic was getting out on the ports, the root cause was
a wrong configuration of the Serdes6G, which is used on jr2 pcb111.
This patch fixes this issue by applying the correct configuration.

Fixes: 5e1d417bec92ac ("net: Add MSCC Jaguar2 network driver.")
Signed-off-by: Horatiu Vultur <horatiu.vultur@microchip.com>
Reviewed-by: Ramon Fried <rfried.dev@gmail.com>

diff --git a/drivers/net/mscc_eswitch/jr2_switch.c b/drivers/net/mscc_eswitch/jr2_switch.c
index 9ba6ccc1bba27648f2e783d365e507d7a4548fe6..570d5a5109514a2cf947b27d481bd60cc1d310f5 100644 (file)
--- a/drivers/net/mscc_eswitch/jr2_switch.c
+++ b/drivers/net/mscc_eswitch/jr2_switch.c
@@ -369,7 +369,6 @@ static void serdes6g_setup(void __iomem *base, uint32_t addr,
 {
        u32 ib_if_mode = 0;
        u32 ib_qrate = 0;
-       u32 ib_cal_ena = 0;
        u32 ib1_tsdet = 0;
        u32 ob_lev = 0;
        u32 ob_ena_cas = 0;
@@ -381,7 +380,6 @@ static void serdes6g_setup(void __iomem *base, uint32_t addr,
        case PHY_INTERFACE_MODE_SGMII:
                ib_if_mode = 1;
                ib_qrate = 1;
-               ib_cal_ena = 1;
                ib1_tsdet = 3;
                ob_lev = 48;
                ob_ena_cas = 2;
@@ -404,6 +402,12 @@ static void serdes6g_setup(void __iomem *base, uint32_t addr,
        if (interface == PHY_INTERFACE_MODE_QSGMII)
                writel(0xfff, base + HSIO_HW_CFGSTAT_HW_CFG);
 
+       writel(HSIO_ANA_SERDES6G_OB_CFG_RESISTOR_CTRL(1) |
+              HSIO_ANA_SERDES6G_OB_CFG_SR(7) |
+              HSIO_ANA_SERDES6G_OB_CFG_SR_H |
+              HSIO_ANA_SERDES6G_OB_CFG_ENA1V_MODE(ob_ena1v_mode) |
+              HSIO_ANA_SERDES6G_OB_CFG_POL, base + HSIO_ANA_SERDES6G_OB_CFG);
+
        writel(HSIO_ANA_SERDES6G_COMMON_CFG_IF_MODE(3),
               base + HSIO_ANA_SERDES6G_COMMON_CFG);
        writel(HSIO_ANA_SERDES6G_PLL_CFG_FSM_CTRL_DATA(120) |
@@ -433,6 +437,21 @@ static void serdes6g_setup(void __iomem *base, uint32_t addr,
               HSIO_ANA_SERDES6G_IB_CFG1_TSDET(3) |
               HSIO_ANA_SERDES6G_IB_CFG1_TJTAG(8),
               base + HSIO_ANA_SERDES6G_IB_CFG1);
+
+       writel(HSIO_ANA_SERDES6G_IB_CFG2_UREG(4) |
+              HSIO_ANA_SERDES6G_IB_CFG2_UMAX(2) |
+              HSIO_ANA_SERDES6G_IB_CFG2_TCALV(12) |
+              HSIO_ANA_SERDES6G_IB_CFG2_OCALS(32) |
+              HSIO_ANA_SERDES6G_IB_CFG2_OINFS(7) |
+              HSIO_ANA_SERDES6G_IB_CFG2_OINFI(0x1f) |
+              HSIO_ANA_SERDES6G_IB_CFG2_TINFV(3),
+              base + HSIO_ANA_SERDES6G_IB_CFG2);
+
+       writel(HSIO_ANA_SERDES6G_IB_CFG3_INI_OFFSET(0x1f) |
+              HSIO_ANA_SERDES6G_IB_CFG3_INI_LP(1) |
+              HSIO_ANA_SERDES6G_IB_CFG3_INI_MID(0x1f),
+              base + HSIO_ANA_SERDES6G_IB_CFG3);
+
        writel(HSIO_DIG_SERDES6G_MISC_CFG_LANE_RST,
               base + HSIO_DIG_SERDES6G_MISC_CFG);
 
@@ -507,7 +526,7 @@ static void serdes6g_setup(void __iomem *base, uint32_t addr,
        writel(HSIO_ANA_SERDES6G_IB_CFG_REG_ENA |
               HSIO_ANA_SERDES6G_IB_CFG_EQZ_ENA |
               HSIO_ANA_SERDES6G_IB_CFG_SAM_ENA |
-              HSIO_ANA_SERDES6G_IB_CFG_CAL_ENA(ib_cal_ena) |
+              HSIO_ANA_SERDES6G_IB_CFG_CAL_ENA(1) |
               HSIO_ANA_SERDES6G_IB_CFG_CONCUR |
               HSIO_ANA_SERDES6G_IB_CFG_SIG_DET_ENA |
               HSIO_ANA_SERDES6G_IB_CFG_REG_PAT_SEL_OFF(0) |
@@ -532,7 +551,7 @@ static void serdes6g_setup(void __iomem *base, uint32_t addr,
        writel(HSIO_ANA_SERDES6G_IB_CFG_REG_ENA |
               HSIO_ANA_SERDES6G_IB_CFG_EQZ_ENA |
               HSIO_ANA_SERDES6G_IB_CFG_SAM_ENA |
-              HSIO_ANA_SERDES6G_IB_CFG_CAL_ENA(ib_cal_ena) |
+              HSIO_ANA_SERDES6G_IB_CFG_CAL_ENA(1) |
               HSIO_ANA_SERDES6G_IB_CFG_CONCUR |
               HSIO_ANA_SERDES6G_IB_CFG_SIG_DET_ENA |
               HSIO_ANA_SERDES6G_IB_CFG_REG_PAT_SEL_OFF(0) |