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>

1 files changed, 16 insertions, 0 deletions

diff --git a/drivers/usb/gadget/r8a66597-udc.c b/drivers/usb/gadget/r8a66597-udc.c
index b8b30059f8af..50991e5bd5e8 100644
--- 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)