usb: gadget: r8a66597-udc: add support for set_selfpowered
authorShimoda, Yoshihiro <yoshihiro.shimoda.uh@renesas.com>
Wed, 11 Apr 2012 09:51:28 +0000 (18:51 +0900)
committerFelipe Balbi <balbi@ti.com>
Fri, 4 May 2012 12:53:07 +0000 (15:53 +0300)
The previous code always set to USB_DEVICE_SELF_POWERED in GET_STATUS.
So, this patch adds set_selfpowered().

Signed-off-by: Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>
drivers/usb/gadget/r8a66597-udc.c
drivers/usb/gadget/r8a66597-udc.h

index b54152b962ffdb9960a12e0e47caa083de049d84..f3ac2a20c27caac8097db4526c725bc084850585 100644 (file)
@@ -1170,7 +1170,7 @@ __acquires(r8a66597->lock)
 
        switch (ctrl->bRequestType & USB_RECIP_MASK) {
        case USB_RECIP_DEVICE:
-               status = 1 << USB_DEVICE_SELF_POWERED;
+               status = r8a66597->device_status;
                break;
        case USB_RECIP_INTERFACE:
                status = 0;
@@ -1800,11 +1800,24 @@ static int r8a66597_pullup(struct usb_gadget *gadget, int is_on)
        return 0;
 }
 
+static int r8a66597_set_selfpowered(struct usb_gadget *gadget, int is_self)
+{
+       struct r8a66597 *r8a66597 = gadget_to_r8a66597(gadget);
+
+       if (is_self)
+               r8a66597->device_status |= 1 << USB_DEVICE_SELF_POWERED;
+       else
+               r8a66597->device_status &= ~(1 << USB_DEVICE_SELF_POWERED);
+
+       return 0;
+}
+
 static struct usb_gadget_ops r8a66597_gadget_ops = {
        .get_frame              = r8a66597_get_frame,
        .udc_start              = r8a66597_start,
        .udc_stop               = r8a66597_stop,
        .pullup                 = r8a66597_pullup,
+       .set_selfpowered        = r8a66597_set_selfpowered,
 };
 
 static int __exit r8a66597_remove(struct platform_device *pdev)
index 25eb132827398972e4d580e28d35b91300302342..99908c76ccd1cf6972fdb42b1fc65c0f516f6fdd 100644 (file)
@@ -111,6 +111,7 @@ struct r8a66597 {
        u16                     old_vbus;
        u16                     scount;
        u16                     old_dvsq;
+       u16                     device_status;  /* for GET_STATUS */
 
        /* pipe config */
        unsigned char bulk;