[PATCH 1/2] phy: rockchip-inno-usb2: add support for phy-supply

Vasily Khoruzhick
2023-03-07T19:38:13Z

PHY driver needs to enable PHY supply, otherwise port will
remain unpowered.

Signed-off-by: Vasily Khoruzhick <anarsoul@gmail.com>
---
drivers/phy/rockchip/phy-rockchip-inno-usb2.c | 59 ++++++++++++++++++-
1 file changed, 57 insertions(+), 2 deletions(-)

diff --git a/drivers/phy/rockchip/phy-rockchip-inno-usb2.c b/drivers/phy/rockchip/phy-rockchip-inno-usb2.c
index 55e1dbcfef..1ef40b448e 100644
--- a/drivers/phy/rockchip/phy-rockchip-inno-usb2.c
+++ b/drivers/phy/rockchip/phy-rockchip-inno-usb2.c
@@ -19,6 +19,7 @@
#include <asm/io.h>
#include <linux/iopoll.h>
#include <asm/arch-rockchip/clock.h>
+#include <power/regulator.h>

DECLARE_GLOBAL_DATA_PTR;

@@ -62,6 +63,10 @@ struct rockchip_usb2phy {
void *reg_base;
struct clk phyclk;
const struct rockchip_usb2phy_cfg *phy_cfg;
+#if CONFIG_IS_ENABLED(DM_REGULATOR)
+ struct udevice *host_supply;
+ struct udevice *otg_supply;
+#endif
};

static inline int property_enable(void *reg_base,
@@ -86,12 +91,40 @@ struct rockchip_usb2phy_port_cfg *us2phy_get_port(struct phy *phy)
return &phy_cfg->port_cfgs[phy->id];
}

+#if CONFIG_IS_ENABLED(DM_REGULATOR)
+static int rockchip_usb2phy_regulator_set_enable(struct phy *phy, bool enable)
+{
+ struct udevice *parent = dev_get_parent(phy->dev);
+ struct rockchip_usb2phy *priv = dev_get_priv(parent);
+ struct udevice *supply;
+ int ret = 0;
+ if (phy->id == USB2PHY_PORT_HOST)
+ supply = priv->host_supply;
+ else
+ supply = priv->otg_supply;
+
+ if (supply)
+ ret = regulator_set_enable(supply, enable);
+
+ return ret;
+}
+#else
+static int rockchip_usb2phy_regulator_set_enable(struct phy *phy, bool enable)
+{
+ return 0;
+}
+#endif
+
static int rockchip_usb2phy_power_on(struct phy *phy)
{
struct udevice *parent = dev_get_parent(phy->dev);
struct rockchip_usb2phy *priv = dev_get_priv(parent);
const struct rockchip_usb2phy_port_cfg *port_cfg = us2phy_get_port(phy);

+ int ret = rockchip_usb2phy_regulator_set_enable(phy, true);
+ if (ret)
+ return ret;
+
property_enable(priv->reg_base, &port_cfg->phy_sus, false);

/* waiting for the utmi_clk to become stable */
@@ -108,6 +141,10 @@ static int rockchip_usb2phy_power_off(struct phy *phy)

property_enable(priv->reg_base, &port_cfg->phy_sus, true);

+ int ret = rockchip_usb2phy_regulator_set_enable(phy, false);
+ if (ret)
+ return ret;
+
return 0;
}

@@ -149,11 +186,29 @@ static int rockchip_usb2phy_of_xlate(struct phy *phy,
struct ofnode_phandle_args *args)
{
const char *name = phy->dev->name;
+ struct udevice *parent = dev_get_parent(phy->dev);
+ struct rockchip_usb2phy *priv = dev_get_priv(parent);
+#if CONFIG_IS_ENABLED(DM_REGULATOR)
+ struct udevice *supply;
+ int ret = device_get_supply_regulator(phy->dev, "phy-supply", &supply);
+ if (ret && ret != -ENOENT) {
+ pr_err("Failed to get PHY regulator\n");
+ return ret;
+ }
+#endif

- if (!strcasecmp(name, "host-port"))
+ if (!strcasecmp(name, "host-port")) {
phy->id = USB2PHY_PORT_HOST;
- else if (!strcasecmp(name, "otg-port"))
+#if CONFIG_IS_ENABLED(DM_REGULATOR)
+ priv->host_supply = supply;
+#endif
+ }
+ else if (!strcasecmp(name, "otg-port")) {
phy->id = USB2PHY_PORT_OTG;
+#if CONFIG_IS_ENABLED(DM_REGULATOR)
+ priv->otg_supply = supply;
+#endif
+ }
else
dev_err(phy->dev, "improper %s device\n", name);

--
2.39.2