Add optional clk for nop phy

Signed-off-by: Peng Fan <peng....@nxp.com>
---
 drivers/phy/nop-phy.c | 34 ++++++++++++++++++++++++++++++++++
 1 file changed, 34 insertions(+)

diff --git a/drivers/phy/nop-phy.c b/drivers/phy/nop-phy.c
index a5eed20f3f..a1afdef736 100644
--- a/drivers/phy/nop-phy.c
+++ b/drivers/phy/nop-phy.c
@@ -4,17 +4,49 @@
  * Written by Jean-Jacques Hiblot  <jjhib...@ti.com>
  */
 
+#include <clk.h>
 #include <common.h>
 #include <dm.h>
 #include <dm/device.h>
 #include <generic-phy.h>
 
+struct nop_phy_priv {
+       struct clk nop_clk;
+};
+
+static int nop_phy_init(struct phy *phy)
+{
+       struct nop_phy_priv *priv = dev_get_priv(phy->dev);
+
+       if (!clk_valid(&priv->nop_clk))
+               return 0;
+
+       return clk_enable(&priv->nop_clk);
+}
+
+static int nop_phy_probe(struct udevice *dev)
+{
+       struct nop_phy_priv *priv = dev_get_priv(dev);
+       int ret;
+
+       if (CONFIG_IS_ENABLED(CLK)) {
+               ret = clk_get_by_name(dev, "main_clk", &priv->nop_clk);
+               if (ret < 0 && ret != -ENODATA) {
+                       dev_err(dev, "Failed to get main_clk: %d\n", ret);
+                       return ret;
+               }
+       }
+
+       return 0;
+}
+
 static const struct udevice_id nop_phy_ids[] = {
        { .compatible = "nop-phy" },
        { }
 };
 
 static struct phy_ops nop_phy_ops = {
+       .init = nop_phy_init,
 };
 
 U_BOOT_DRIVER(nop_phy) = {
@@ -22,4 +54,6 @@ U_BOOT_DRIVER(nop_phy) = {
        .id     = UCLASS_PHY,
        .of_match = nop_phy_ids,
        .ops = &nop_phy_ops,
+       .probe = nop_phy_probe,
+       .priv_auto_alloc_size = sizeof(struct nop_phy_priv),
 };
-- 
2.28.0

Reply via email to