Add soft reset support to cleanup_halted_endpoint().
using soft reset will prevent it from setting a new dequeue pointer to
start the transfer from. Let it continue where it halted.

Signed-off-by: Mathias Nyman <[email protected]>
---
 drivers/usb/host/xhci-ring.c | 16 ++++++++++------
 1 file changed, 10 insertions(+), 6 deletions(-)

diff --git a/drivers/usb/host/xhci-ring.c b/drivers/usb/host/xhci-ring.c
index ae55ed1..1dd00dc 100644
--- a/drivers/usb/host/xhci-ring.c
+++ b/drivers/usb/host/xhci-ring.c
@@ -1819,7 +1819,8 @@ struct xhci_segment *trb_in_td(struct xhci_hcd *xhci,
 static void xhci_cleanup_halted_endpoint(struct xhci_hcd *xhci,
                unsigned int slot_id, unsigned int ep_index,
                unsigned int stream_id,
-               struct xhci_td *td, union xhci_trb *ep_trb)
+               struct xhci_td *td, union xhci_trb *ep_trb,
+               enum xhci_ep_reset_type reset_type)
 {
        struct xhci_virt_ep *ep = &xhci->devs[slot_id]->eps[ep_index];
        struct xhci_command *command;
@@ -1828,12 +1829,14 @@ static void xhci_cleanup_halted_endpoint(struct 
xhci_hcd *xhci,
                return;
 
        ep->ep_state |= EP_HALTED;
-       ep->stopped_stream = stream_id;
 
-       xhci_queue_reset_ep(xhci, command, slot_id, ep_index, EP_HARD_RESET);
-       xhci_cleanup_stalled_ring(xhci, ep_index, td);
+       xhci_queue_reset_ep(xhci, command, slot_id, ep_index, reset_type);
 
-       ep->stopped_stream = 0;
+       if (reset_type == EP_HARD_RESET) {
+               ep->stopped_stream = stream_id;
+               xhci_cleanup_stalled_ring(xhci, ep_index, td);
+               ep->stopped_stream = 0;
+       }
 
        xhci_ring_cmd_db(xhci);
 }
@@ -1965,7 +1968,8 @@ static int finish_td(struct xhci_hcd *xhci, struct 
xhci_td *td,
                 * The class driver clears the device side halt later.
                 */
                xhci_cleanup_halted_endpoint(xhci, slot_id, ep_index,
-                                       ep_ring->stream_id, td, ep_trb);
+                                       ep_ring->stream_id, td, ep_trb,
+                                       EP_HARD_RESET);
        } else {
                /* Update ring dequeue pointer */
                while (ep_ring->dequeue != td->last_trb)
-- 
1.9.1

--
To unsubscribe from this list: send the line "unsubscribe linux-usb" in
the body of a message to [email protected]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to