phy: qcom-qusb2: Power-on PHY before initialization
PHY must be powered on before turning ON clocks and attempting to initialize it. Driver is exposing separate init and power_on routines for this. Apparently USB dwc3 core driver performs power-on after init. Also, poweron and init for QUSB2 PHY need to be executed together always, hence remove poweron callback from phy_ops and explicitly perform this from init, similar changes needed for poweroff. Signed-off-by: Manu Gautam <mgautam@codeaurora.org> Reviewed-by: Vivek Gautam <vivek.gautam@codeaurora.org> Signed-off-by: Kishon Vijay Abraham I <kishon@ti.com>
This commit is contained in:
parent
717dab9d67
commit
937e17f36a
|
@ -195,40 +195,6 @@ static void qusb2_phy_set_tune2_param(struct qusb2_phy *qphy)
|
||||||
qusb2_setbits(qphy->base, QUSB2PHY_PORT_TUNE2, val[0] << 0x4);
|
qusb2_setbits(qphy->base, QUSB2PHY_PORT_TUNE2, val[0] << 0x4);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int qusb2_phy_poweron(struct phy *phy)
|
|
||||||
{
|
|
||||||
struct qusb2_phy *qphy = phy_get_drvdata(phy);
|
|
||||||
int num = ARRAY_SIZE(qphy->vregs);
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
dev_vdbg(&phy->dev, "%s(): Powering-on QUSB2 phy\n", __func__);
|
|
||||||
|
|
||||||
/* turn on regulator supplies */
|
|
||||||
ret = regulator_bulk_enable(num, qphy->vregs);
|
|
||||||
if (ret)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
ret = clk_prepare_enable(qphy->iface_clk);
|
|
||||||
if (ret) {
|
|
||||||
dev_err(&phy->dev, "failed to enable iface_clk, %d\n", ret);
|
|
||||||
regulator_bulk_disable(num, qphy->vregs);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int qusb2_phy_poweroff(struct phy *phy)
|
|
||||||
{
|
|
||||||
struct qusb2_phy *qphy = phy_get_drvdata(phy);
|
|
||||||
|
|
||||||
clk_disable_unprepare(qphy->iface_clk);
|
|
||||||
|
|
||||||
regulator_bulk_disable(ARRAY_SIZE(qphy->vregs), qphy->vregs);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int qusb2_phy_init(struct phy *phy)
|
static int qusb2_phy_init(struct phy *phy)
|
||||||
{
|
{
|
||||||
struct qusb2_phy *qphy = phy_get_drvdata(phy);
|
struct qusb2_phy *qphy = phy_get_drvdata(phy);
|
||||||
|
@ -238,11 +204,22 @@ static int qusb2_phy_init(struct phy *phy)
|
||||||
|
|
||||||
dev_vdbg(&phy->dev, "%s(): Initializing QUSB2 phy\n", __func__);
|
dev_vdbg(&phy->dev, "%s(): Initializing QUSB2 phy\n", __func__);
|
||||||
|
|
||||||
|
/* turn on regulator supplies */
|
||||||
|
ret = regulator_bulk_enable(ARRAY_SIZE(qphy->vregs), qphy->vregs);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ret = clk_prepare_enable(qphy->iface_clk);
|
||||||
|
if (ret) {
|
||||||
|
dev_err(&phy->dev, "failed to enable iface_clk, %d\n", ret);
|
||||||
|
goto poweroff_phy;
|
||||||
|
}
|
||||||
|
|
||||||
/* enable ahb interface clock to program phy */
|
/* enable ahb interface clock to program phy */
|
||||||
ret = clk_prepare_enable(qphy->cfg_ahb_clk);
|
ret = clk_prepare_enable(qphy->cfg_ahb_clk);
|
||||||
if (ret) {
|
if (ret) {
|
||||||
dev_err(&phy->dev, "failed to enable cfg ahb clock, %d\n", ret);
|
dev_err(&phy->dev, "failed to enable cfg ahb clock, %d\n", ret);
|
||||||
return ret;
|
goto disable_iface_clk;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Perform phy reset */
|
/* Perform phy reset */
|
||||||
|
@ -344,6 +321,11 @@ assert_phy_reset:
|
||||||
reset_control_assert(qphy->phy_reset);
|
reset_control_assert(qphy->phy_reset);
|
||||||
disable_ahb_clk:
|
disable_ahb_clk:
|
||||||
clk_disable_unprepare(qphy->cfg_ahb_clk);
|
clk_disable_unprepare(qphy->cfg_ahb_clk);
|
||||||
|
disable_iface_clk:
|
||||||
|
clk_disable_unprepare(qphy->iface_clk);
|
||||||
|
poweroff_phy:
|
||||||
|
regulator_bulk_disable(ARRAY_SIZE(qphy->vregs), qphy->vregs);
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -361,6 +343,9 @@ static int qusb2_phy_exit(struct phy *phy)
|
||||||
reset_control_assert(qphy->phy_reset);
|
reset_control_assert(qphy->phy_reset);
|
||||||
|
|
||||||
clk_disable_unprepare(qphy->cfg_ahb_clk);
|
clk_disable_unprepare(qphy->cfg_ahb_clk);
|
||||||
|
clk_disable_unprepare(qphy->iface_clk);
|
||||||
|
|
||||||
|
regulator_bulk_disable(ARRAY_SIZE(qphy->vregs), qphy->vregs);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -368,8 +353,6 @@ static int qusb2_phy_exit(struct phy *phy)
|
||||||
static const struct phy_ops qusb2_phy_gen_ops = {
|
static const struct phy_ops qusb2_phy_gen_ops = {
|
||||||
.init = qusb2_phy_init,
|
.init = qusb2_phy_init,
|
||||||
.exit = qusb2_phy_exit,
|
.exit = qusb2_phy_exit,
|
||||||
.power_on = qusb2_phy_poweron,
|
|
||||||
.power_off = qusb2_phy_poweroff,
|
|
||||||
.owner = THIS_MODULE,
|
.owner = THIS_MODULE,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue