usb: dwc3: gadget: properly account queued requests

Some requests could be accounted for multiple
times. Let's fix that so each and every requests is
accounted for only once.

Cc: <stable@vger.kernel.org> # v4.8
Fixes: 55a0237f8f47 ("usb: dwc3: gadget: use allocated/queued reqs for LST bit")
Signed-off-by: Felipe Balbi <felipe.balbi@linux.intel.com>

1 files changed, 5 insertions, 3 deletions

diff --git a/drivers/usb/dwc3/gadget.c b/drivers/usb/dwc3/gadget.c
index 07cc8929f271..3c3ced128c77 100644
--- a/drivers/usb/dwc3/gadget.c
+++ b/drivers/usb/dwc3/gadget.c
@@ -783,6 +783,7 @@ static void dwc3_prepare_one_trb(struct dwc3_ep *dep,
                 req->trb = trb;
                 req->trb_dma = dwc3_trb_dma_offset(dep, trb);
                 req->first_trb_index = dep->trb_enqueue;
+                dep->queued_requests++;
         }
 
         dwc3_ep_inc_enq(dep);
@@ -833,8 +834,6 @@ static void dwc3_prepare_one_trb(struct dwc3_ep *dep,
 
         trb->ctrl |= DWC3_TRB_CTRL_HWO;
 
-        dep->queued_requests++;
-
         trace_dwc3_prepare_trb(dep, trb);
 }
 
@@ -1861,8 +1860,11 @@ static int __dwc3_cleanup_done_trbs(struct dwc3 *dwc, struct dwc3_ep *dep,
         unsigned int            s_pkt = 0;
         unsigned int            trb_status;
 
-        dep->queued_requests--;
         dwc3_ep_inc_deq(dep);
+
+        if (req->trb == trb)
+                dep->queued_requests--;
+
         trace_dwc3_complete_trb(dep, trb);
 
         /*