[<prev] [next>] [thread-next>] [day] [month] [year] [list]
Message-Id: <20250410070453.61178-1-minda.chen@starfivetech.com>
Date: Thu, 10 Apr 2025 15:04:53 +0800
From: Minda Chen <minda.chen@...rfivetech.com>
To: Emil Renner Berthing <kernel@...il.dk>,
Andrew Lunn <andrew+netdev@...n.ch>,
"David S . Miller" <davem@...emloft.net>,
Eric Dumazet <edumazet@...gle.com>,
Jakub Kicinski <kuba@...nel.org>,
Paolo Abeni <pabeni@...hat.com>,
Maxime Coquelin <mcoquelin.stm32@...il.com>,
Alexandre Torgue <alexandre.torgue@...s.st.com>,
netdev@...r.kernel.org
Cc: linux-kernel@...r.kernel.org,
linux-stm32@...md-mailman.stormreply.com,
Minda Chen <minda.chen@...rfivetech.com>
Subject: [net-next v1] net: stmmac: starfive: Add serdes PHY init/deinit function
To support SGMII interface, add internal serdes PHY powerup/
powerdown function.
Signed-off-by: Minda Chen <minda.chen@...rfivetech.com>
---
.../ethernet/stmicro/stmmac/dwmac-starfive.c | 33 +++++++++++++++++++
1 file changed, 33 insertions(+)
diff --git a/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive.c b/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive.c
index 2013d7477eb7..f5923f847100 100644
--- a/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive.c
+++ b/drivers/net/ethernet/stmicro/stmmac/dwmac-starfive.c
@@ -9,6 +9,8 @@
#include <linux/mod_devicetable.h>
#include <linux/platform_device.h>
+#include <linux/phy.h>
+#include <linux/phy/phy.h>
#include <linux/property.h>
#include <linux/mfd/syscon.h>
#include <linux/regmap.h>
@@ -28,6 +30,7 @@ struct starfive_dwmac_data {
struct starfive_dwmac {
struct device *dev;
const struct starfive_dwmac_data *data;
+ struct phy *serdes_phy;
};
static int starfive_dwmac_set_mode(struct plat_stmmacenet_data *plat_dat)
@@ -80,6 +83,26 @@ static int starfive_dwmac_set_mode(struct plat_stmmacenet_data *plat_dat)
return 0;
}
+static int starfive_dwmac_serdes_powerup(struct net_device *ndev, void *priv)
+{
+ struct starfive_dwmac *dwmac = priv;
+ int ret;
+
+ ret = phy_init(dwmac->serdes_phy);
+ if (ret)
+ return ret;
+
+ return phy_power_on(dwmac->serdes_phy);
+}
+
+static void starfive_dwmac_serdes_powerdown(struct net_device *ndev, void *priv)
+{
+ struct starfive_dwmac *dwmac = priv;
+
+ phy_power_off(dwmac->serdes_phy);
+ phy_exit(dwmac->serdes_phy);
+}
+
static int starfive_dwmac_probe(struct platform_device *pdev)
{
struct plat_stmmacenet_data *plat_dat;
@@ -102,6 +125,11 @@ static int starfive_dwmac_probe(struct platform_device *pdev)
if (!dwmac)
return -ENOMEM;
+ dwmac->serdes_phy = devm_phy_optional_get(&pdev->dev, NULL);
+ if (IS_ERR(dwmac->serdes_phy))
+ return dev_err_probe(&pdev->dev, PTR_ERR(dwmac->serdes_phy),
+ "Failed to get serdes phy\n");
+
dwmac->data = device_get_match_data(&pdev->dev);
plat_dat->clk_tx_i = devm_clk_get_enabled(&pdev->dev, "tx");
@@ -132,6 +160,11 @@ static int starfive_dwmac_probe(struct platform_device *pdev)
if (err)
return err;
+ if (dwmac->serdes_phy) {
+ plat_dat->serdes_powerup = starfive_dwmac_serdes_powerup;
+ plat_dat->serdes_powerdown = starfive_dwmac_serdes_powerdown;
+ }
+
return stmmac_dvr_probe(&pdev->dev, plat_dat, &stmmac_res);
}
--
2.17.1
Powered by blists - more mailing lists