net: mediatek: fix direct MDIO clause 45 access via SoC

The original direct MDIO clause 45 access via SoC is missing the
data output. This patch adds it back to ensure MDIO clause 45 can
work properly for external PHYs.

Signed-off-by: Weijie Gao <[email protected]>

diff --git a/drivers/net/mtk_eth.c b/drivers/net/mtk_eth.c
index cd72070ff625c05426712b9bd8d07f6297a4e84f..61a1c29e361885706ddb7679acb7f38672dc1931 100644 (file)
--- a/drivers/net/mtk_eth.c
+++ b/drivers/net/mtk_eth.c
@@ -198,7 +198,7 @@ static int mtk_mii_rw(struct mtk_eth_priv *priv, u8 phy, u8 reg, u16 data,
              (((u32)phy << MDIO_PHY_ADDR_S) & MDIO_PHY_ADDR_M) |
              (((u32)reg << MDIO_REG_ADDR_S) & MDIO_REG_ADDR_M);
 
-       if (cmd == MDIO_CMD_WRITE)
+       if (cmd == MDIO_CMD_WRITE || cmd == MDIO_CMD_ADDR)
                val |= data & MDIO_RW_DATA_M;
 
        mtk_gmac_write(priv, GMAC_PIAC_REG, val | PHY_ACS_ST);
@@ -210,7 +210,7 @@ static int mtk_mii_rw(struct mtk_eth_priv *priv, u8 phy, u8 reg, u16 data,
                return ret;
        }
 
-       if (cmd == MDIO_CMD_READ) {
+       if (cmd == MDIO_CMD_READ || cmd == MDIO_CMD_READ_C45) {
                val = mtk_gmac_read(priv, GMAC_PIAC_REG);
                return val & MDIO_RW_DATA_M;
        }