phy: rockchip: inno-usb2: fix charge detection

Fixes: 61b9414d71 ("phy: rockchip: inno-usb2: keep utmi clk on during charge detection")
Signed-off-by: William Wu <william.wu@rock-chips.com>
Change-Id: Ifcaf0ec333399a73a0c7af32cc053379763b83c2
This commit is contained in:
William Wu
2021-11-17 10:23:47 +08:00
committed by Tao Huang
parent 4450c2a62e
commit 8dae8f2c0d

View File

@@ -1314,13 +1314,15 @@ static void rockchip_chg_detect_work(struct work_struct *work)
rphy->chg_state = USB_CHG_STATE_DETECTED;
fallthrough;
case USB_CHG_STATE_DETECTED:
if (rphy->phy_cfg->chg_det.chg_mode.offset !=
rport->port_cfg->phy_sus.offset)
property_enable(base, &rphy->phy_cfg->chg_det.chg_mode, false);
/* Restore the PHY suspend configuration */
phy_sus_reg = &rport->port_cfg->phy_sus;
mask = GENMASK(phy_sus_reg->bitend, phy_sus_reg->bitstart);
ret = regmap_write(base, phy_sus_reg->offset,
((rphy->phy_sus_cfg <<
phy_sus_reg->bitstart) |
(mask << BIT_WRITEABLE_SHIFT)));
(rphy->phy_sus_cfg | (mask << BIT_WRITEABLE_SHIFT)));
if (ret)
dev_err(&rport->phy->dev,
"Fail to set phy_sus reg offset 0x%x, ret %d\n",