1 files changed, 7 insertions, 2 deletions

diff --git a/drivers/usb/gadget/pxa2xx_udc.c b/drivers/usb/gadget/pxa2xx_udc.c
index 4abf9d26d615..8bd9ce26bd95 100644
--- a/drivers/usb/gadget/pxa2xx_udc.c
+++ b/drivers/usb/gadget/pxa2xx_udc.c
@@ -127,8 +127,10 @@ static int is_vbus_present(void)
 {
         struct pxa2xx_udc_mach_info             *mach = the_controller->mach;
 
-        if (mach->gpio_vbus)
-                return gpio_get_value(mach->gpio_vbus);
+        if (mach->gpio_vbus) {
+                int value = gpio_get_value(mach->gpio_vbus);
+                return mach->gpio_vbus_inverted ? !value : value;
+        }
         if (mach->udc_is_connected)
                 return mach->udc_is_connected();
         return 1;
@@ -1398,6 +1400,9 @@ static irqreturn_t udc_vbus_irq(int irq, void *_dev)
         struct pxa2xx_udc       *dev = _dev;
         int                     vbus = gpio_get_value(dev->mach->gpio_vbus);
 
+        if (dev->mach->gpio_vbus_inverted)
+                vbus = !vbus;
+
         pxa2xx_udc_vbus_session(&dev->gadget, vbus);
         return IRQ_HANDLED;
 }