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>
Reviewed-by: Sean Anderson <seanga2@gmail.com>
Link: https://lore.kernel.org/r/bbc8d7ed9d308199168e4455c7a3e3a5ac0890e7.1639562397.git.michal.simek@xilinx.com
diff --git a/drivers/net/zynq_gem.c b/drivers/net/zynq_gem.c
index 56f668c..336d569 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>
@@ -713,6 +714,19 @@
void *bd_space;
struct zynq_gem_priv *priv = dev_get_priv(dev);
int ret;
+ struct phy phy;
+
+ if (priv->interface == PHY_INTERFACE_MODE_SGMII) {
+ ret = generic_phy_get_by_index(dev, 0, &phy);
+ if (!ret) {
+ ret = generic_phy_init(&phy);
+ if (ret)
+ return ret;
+ } else if (ret != -ENOENT) {
+ debug("could not get phy (err %d)\n", ret);
+ return ret;
+ }
+ }
ret = zynq_gem_reset_init(dev);
if (ret)
@@ -769,6 +783,12 @@
if (ret)
goto err3;
+ if (priv->interface == PHY_INTERFACE_MODE_SGMII && phy.dev) {
+ ret = generic_phy_power_on(&phy);
+ if (ret)
+ return ret;
+ }
+
return ret;
err3: