phy: sun4i-usb: Refactor VBUS detection to match Linux

The Linux driver checks the VBUS detection GPIO first; then VBUS power
supply; then finally assumes VBUS is present. When adding VBUS power
supply support, we want to match that order, so we get the same behavior
in case both a GPIO and a power supply are provided in the device tree.

So refactor the function a bit to remove the early return, and use the
same "assume VBUS is present" final fallback.

Signed-off-by: Samuel Holland <samuel@sholland.org>
Acked-by: Andre Przywara <andre.przywara@arm.com>
Signed-off-by: Andre Przywara <andre.przywara@arm.com>
This commit is contained in:
Samuel Holland 2021-09-12 09:22:41 -05:00 committed by Andre Przywara
parent 6617894b69
commit 1da7b88cad

View File

@ -391,21 +391,20 @@ int sun4i_usb_phy_vbus_detect(struct phy *phy)
{ {
struct sun4i_usb_phy_data *data = dev_get_priv(phy->dev); struct sun4i_usb_phy_data *data = dev_get_priv(phy->dev);
struct sun4i_usb_phy_plat *usb_phy = &data->usb_phy[phy->id]; struct sun4i_usb_phy_plat *usb_phy = &data->usb_phy[phy->id];
int err, retries = 3; int err = 1, retries = 3;
if (usb_phy->gpio_vbus_det < 0)
return usb_phy->gpio_vbus_det;
if (usb_phy->gpio_vbus_det >= 0) {
err = gpio_get_value(usb_phy->gpio_vbus_det); err = gpio_get_value(usb_phy->gpio_vbus_det);
/* /*
* Vbus may have been provided by the board and just been turned of * Vbus may have been provided by the board and just turned off
* some milliseconds ago on reset, what we're measuring then is a * some milliseconds ago on reset. What we're measuring then is
* residual charge on Vbus, sleep a bit and try again. * a residual charge on Vbus. Sleep a bit and try again.
*/ */
while (err > 0 && retries--) { while (err > 0 && retries--) {
mdelay(100); mdelay(100);
err = gpio_get_value(usb_phy->gpio_vbus_det); err = gpio_get_value(usb_phy->gpio_vbus_det);
} }
}
return err; return err;
} }