From: Michal Simek <michal.simek@xilinx.com>
Date: Tue, 26 Oct 2021 12:26:18 +0000 (+0200)
Subject: net: zynq: Add support for PHY configuration in SGMII mode
X-Git-Url: http://git.ipfire.org/?a=commitdiff_plain;h=7b96f287ac78042db48469e6417077ee7649eba6;p=thirdparty%2Fu-boot.git

net: zynq: Add support for PHY configuration in SGMII mode

SGMII configuration depends on proper GT setting that's why when node has
phys property call PSGTR driver to configure it properly.

Signed-off-by: Michal Simek <michal.simek@xilinx.com>
---

diff --git a/drivers/net/zynq_gem.c b/drivers/net/zynq_gem.c
index 56f668c2496..8e77711acb7 100644
--- a/drivers/net/zynq_gem.c
+++ b/drivers/net/zynq_gem.c
@@ -12,6 +12,7 @@
 #include <common.h>
 #include <cpu_func.h>
 #include <dm.h>
+#include <generic-phy.h>
 #include <log.h>
 #include <net.h>
 #include <netdev.h>
@@ -714,6 +715,21 @@ static int zynq_gem_probe(struct udevice *dev)
 	struct zynq_gem_priv *priv = dev_get_priv(dev);
 	int ret;
 
+	if (priv->interface == PHY_INTERFACE_MODE_SGMII) {
+		struct phy phy;
+
+		ret = generic_phy_get_by_index(dev, 0, &phy);
+		if (!ret) {
+			ret = generic_phy_init(&phy);
+			if (ret)
+				return ret;
+
+			ret = generic_phy_power_on(&phy);
+			if (ret)
+				return ret;
+		}
+	}
+
 	ret = zynq_gem_reset_init(dev);
 	if (ret)
 		return ret;