usb: gadget: r8a66597-udc: add pullup function

Signed-off-by: Yoshihiro Shimoda <yoshihiro.shimoda.uh@renesas.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>

diff --git a/drivers/usb/gadget/r8a66597-udc.c b/drivers/usb/gadget/r8a66597-udc.c
index b8b30059f8af3b21d7784fea122d3525de553024..50991e5bd5e8e6e9238f9382e4e8af0202055228 100644 (file)
--- a/drivers/usb/gadget/r8a66597-udc.c
+++ b/drivers/usb/gadget/r8a66597-udc.c
@@ -1518,10 +1518,26 @@ static int r8a66597_get_frame(struct usb_gadget *_gadget)
        return r8a66597_read(r8a66597, FRMNUM) & 0x03FF;
 }
 
+static int r8a66597_pullup(struct usb_gadget *gadget, int is_on)
+{
+       struct r8a66597 *r8a66597 = gadget_to_r8a66597(gadget);
+       unsigned long flags;
+
+       spin_lock_irqsave(&r8a66597->lock, flags);
+       if (is_on)
+               r8a66597_bset(r8a66597, DPRPU, SYSCFG0);
+       else
+               r8a66597_bclr(r8a66597, DPRPU, SYSCFG0);
+       spin_unlock_irqrestore(&r8a66597->lock, flags);
+
+       return 0;
+}
+
 static struct usb_gadget_ops r8a66597_gadget_ops = {
        .get_frame              = r8a66597_get_frame,
        .start                  = r8a66597_start,
        .stop                   = r8a66597_stop,
+       .pullup                 = r8a66597_pullup,
 };
 
 static int __exit r8a66597_remove(struct platform_device *pdev)