usb: gadget: mv_udc: fix bug when handle setup package.

For the code doesn't restrict controller ep must be ep0, so we will go
through all the eps and check if there is a setup package received.
And also we just need to acknowledge the corresponding bit in
ENDPTSETUPSTAT register.

Signed-off-by: Neil Zhang <zhangwm@marvell.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>

1 files changed, 1 insertions, 2 deletions

diff --git a/drivers/usb/gadget/mv_udc_core.c b/drivers/usb/gadget/mv_udc_core.c
index 8dab8c4d10bd..fcb980def624 100644
--- a/drivers/usb/gadget/mv_udc_core.c
+++ b/drivers/usb/gadget/mv_udc_core.c
@@ -1631,8 +1631,7 @@ static void get_setup_data(struct mv_udc *udc, u8 ep_num, u8 *buffer_ptr)
         dqh = &udc->ep_dqh[ep_num * 2 + EP_DIR_OUT];
 
         /* Clear bit in ENDPTSETUPSTAT */
-        temp = readl(&udc->op_regs->epsetupstat);
-        writel(temp | (1 << ep_num), &udc->op_regs->epsetupstat);
+        writel((1 << ep_num), &udc->op_regs->epsetupstat);
 
         /* while a hazard exists when setup package arrives */
         do {