usb: gadget: m66592-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/m66592-udc.c b/drivers/usb/gadget/m66592-udc.c
index 5c9c04d7aa76cfda2b46ef46089aabebf082a097..491f825ed5c93b1e1e525c2f5ae8ffefdf88c23a 100644 (file)
--- a/drivers/usb/gadget/m66592-udc.c
+++ b/drivers/usb/gadget/m66592-udc.c
@@ -1561,10 +1561,26 @@ static int m66592_get_frame(struct usb_gadget *_gadget)
        return m66592_read(m66592, M66592_FRMNUM) & 0x03FF;
 }
 
+static int m66592_pullup(struct usb_gadget *gadget, int is_on)
+{
+       struct m66592 *m66592 = gadget_to_m66592(gadget);
+       unsigned long flags;
+
+       spin_lock_irqsave(&m66592->lock, flags);
+       if (is_on)
+               m66592_bset(m66592, M66592_DPRPU, M66592_SYSCFG);
+       else
+               m66592_bclr(m66592, M66592_DPRPU, M66592_SYSCFG);
+       spin_unlock_irqrestore(&m66592->lock, flags);
+
+       return 0;
+}
+
 static struct usb_gadget_ops m66592_gadget_ops = {
        .get_frame              = m66592_get_frame,
        .start                  = m66592_start,
        .stop                   = m66592_stop,
+       .pullup                 = m66592_pullup,
 };
 
 static int __exit m66592_remove(struct platform_device *pdev)