|
@@ -223,6 +223,9 @@ static void ohci_at91_usb_set_power(struct at91_usbh_data *pdata, int port, int
|
|
if (port < 0 || port >= 2)
|
|
if (port < 0 || port >= 2)
|
|
return;
|
|
return;
|
|
|
|
|
|
|
|
+ if (pdata->vbus_pin[port] <= 0)
|
|
|
|
+ return;
|
|
|
|
+
|
|
gpio_set_value(pdata->vbus_pin[port], !pdata->vbus_pin_inverted ^ enable);
|
|
gpio_set_value(pdata->vbus_pin[port], !pdata->vbus_pin_inverted ^ enable);
|
|
}
|
|
}
|
|
|
|
|
|
@@ -231,6 +234,9 @@ static int ohci_at91_usb_get_power(struct at91_usbh_data *pdata, int port)
|
|
if (port < 0 || port >= 2)
|
|
if (port < 0 || port >= 2)
|
|
return -EINVAL;
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
+ if (pdata->vbus_pin[port] <= 0)
|
|
|
|
+ return -EINVAL;
|
|
|
|
+
|
|
return gpio_get_value(pdata->vbus_pin[port]) ^ !pdata->vbus_pin_inverted;
|
|
return gpio_get_value(pdata->vbus_pin[port]) ^ !pdata->vbus_pin_inverted;
|
|
}
|
|
}
|
|
|
|
|