usb: gadget: net2280: physically disable endpoint on disable operation

Reset configuration in ep_cfg on disable to physically disable the
endpoint.

Tested-by: Ricardo Ribalda Delgado <ricardo.ribalda@gmail.com>
Signed-off-by: Mian Yousaf Kaukab <yousaf.kaukab@intel.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>

1 files changed, 7 insertions, 0 deletions

diff --git a/drivers/usb/gadget/udc/net2280.c b/drivers/usb/gadget/udc/net2280.c
index 779e6fe0005f..5740e0d885bc 100644
--- a/drivers/usb/gadget/udc/net2280.c
+++ b/drivers/usb/gadget/udc/net2280.c
@@ -461,6 +461,13 @@ static void ep_reset_338x(struct net2280_regs __iomem *regs,
                BIT(DATA_PACKET_TRANSMITTED_INTERRUPT) |
                BIT(DATA_OUT_PING_TOKEN_INTERRUPT) |
                BIT(DATA_IN_TOKEN_INTERRUPT), &ep->regs->ep_stat);
+
+        tmp = readl(&ep->cfg->ep_cfg);
+        if (ep->is_in)
+                tmp &= ~USB3380_EP_CFG_MASK_IN;
+        else
+                tmp &= ~USB3380_EP_CFG_MASK_OUT;
+        writel(tmp, &ep->cfg->ep_cfg);
 }
 
 static void nuke(struct net2280_ep *);