USB: xhci: Transfer ring link TRB activation change.
Change transfer ring behavior to not follow/activate link TRBs until active TRBs are queued after it. This change affects the behavior when a TD ends just before a link TRB. Signed-off-by: John Youn <johnyoun@synopsys.com> Signed-off-by: Sarah Sharp <sarah.a.sharp@linux.intel.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
committed by
Greg Kroah-Hartman
parent
b0608690c2
commit
6c12db90f1
@@ -112,6 +112,12 @@ static inline int last_trb(struct xhci_hcd *xhci, struct xhci_ring *ring,
|
|||||||
return (trb->link.control & TRB_TYPE_BITMASK) == TRB_TYPE(TRB_LINK);
|
return (trb->link.control & TRB_TYPE_BITMASK) == TRB_TYPE(TRB_LINK);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static inline int enqueue_is_link_trb(struct xhci_ring *ring)
|
||||||
|
{
|
||||||
|
struct xhci_link_trb *link = &ring->enqueue->link;
|
||||||
|
return ((link->control & TRB_TYPE_BITMASK) == TRB_TYPE(TRB_LINK));
|
||||||
|
}
|
||||||
|
|
||||||
/* Updates trb to point to the next TRB in the ring, and updates seg if the next
|
/* Updates trb to point to the next TRB in the ring, and updates seg if the next
|
||||||
* TRB is in a new segment. This does not skip over link TRBs, and it does not
|
* TRB is in a new segment. This does not skip over link TRBs, and it does not
|
||||||
* effect the ring dequeue or enqueue pointers.
|
* effect the ring dequeue or enqueue pointers.
|
||||||
@@ -193,20 +199,15 @@ static void inc_enq(struct xhci_hcd *xhci, struct xhci_ring *ring, bool consumer
|
|||||||
while (last_trb(xhci, ring, ring->enq_seg, next)) {
|
while (last_trb(xhci, ring, ring->enq_seg, next)) {
|
||||||
if (!consumer) {
|
if (!consumer) {
|
||||||
if (ring != xhci->event_ring) {
|
if (ring != xhci->event_ring) {
|
||||||
/* If we're not dealing with 0.95 hardware,
|
if (chain) {
|
||||||
* carry over the chain bit of the previous TRB
|
next->link.control |= TRB_CHAIN;
|
||||||
* (which may mean the chain bit is cleared).
|
|
||||||
*/
|
/* Give this link TRB to the hardware */
|
||||||
if (!xhci_link_trb_quirk(xhci)) {
|
wmb();
|
||||||
next->link.control &= ~TRB_CHAIN;
|
next->link.control ^= TRB_CYCLE;
|
||||||
next->link.control |= chain;
|
} else {
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
/* Give this link TRB to the hardware */
|
|
||||||
wmb();
|
|
||||||
if (next->link.control & TRB_CYCLE)
|
|
||||||
next->link.control &= (u32) ~TRB_CYCLE;
|
|
||||||
else
|
|
||||||
next->link.control |= (u32) TRB_CYCLE;
|
|
||||||
}
|
}
|
||||||
/* Toggle the cycle bit after the last ring segment. */
|
/* Toggle the cycle bit after the last ring segment. */
|
||||||
if (last_trb_on_last_seg(xhci, ring, ring->enq_seg, next)) {
|
if (last_trb_on_last_seg(xhci, ring, ring->enq_seg, next)) {
|
||||||
@@ -245,6 +246,13 @@ static int room_on_ring(struct xhci_hcd *xhci, struct xhci_ring *ring,
|
|||||||
struct xhci_segment *cur_seg;
|
struct xhci_segment *cur_seg;
|
||||||
unsigned int left_on_ring;
|
unsigned int left_on_ring;
|
||||||
|
|
||||||
|
/* If we are currently pointing to a link TRB, advance the
|
||||||
|
* enqueue pointer before checking for space */
|
||||||
|
while (last_trb(xhci, ring, enq_seg, enq)) {
|
||||||
|
enq_seg = enq_seg->next;
|
||||||
|
enq = enq_seg->trbs;
|
||||||
|
}
|
||||||
|
|
||||||
/* Check if ring is empty */
|
/* Check if ring is empty */
|
||||||
if (enq == ring->dequeue) {
|
if (enq == ring->dequeue) {
|
||||||
/* Can't use link trbs */
|
/* Can't use link trbs */
|
||||||
@@ -1728,6 +1736,43 @@ static int prepare_ring(struct xhci_hcd *xhci, struct xhci_ring *ep_ring,
|
|||||||
xhci_err(xhci, "ERROR no room on ep ring\n");
|
xhci_err(xhci, "ERROR no room on ep ring\n");
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (enqueue_is_link_trb(ep_ring)) {
|
||||||
|
struct xhci_ring *ring = ep_ring;
|
||||||
|
union xhci_trb *next;
|
||||||
|
unsigned long long addr;
|
||||||
|
|
||||||
|
xhci_dbg(xhci, "prepare_ring: pointing to link trb\n");
|
||||||
|
next = ring->enqueue;
|
||||||
|
|
||||||
|
while (last_trb(xhci, ring, ring->enq_seg, next)) {
|
||||||
|
|
||||||
|
/* If we're not dealing with 0.95 hardware,
|
||||||
|
* clear the chain bit.
|
||||||
|
*/
|
||||||
|
if (!xhci_link_trb_quirk(xhci))
|
||||||
|
next->link.control &= ~TRB_CHAIN;
|
||||||
|
else
|
||||||
|
next->link.control |= TRB_CHAIN;
|
||||||
|
|
||||||
|
wmb();
|
||||||
|
next->link.control ^= (u32) TRB_CYCLE;
|
||||||
|
|
||||||
|
/* Toggle the cycle bit after the last ring segment. */
|
||||||
|
if (last_trb_on_last_seg(xhci, ring, ring->enq_seg, next)) {
|
||||||
|
ring->cycle_state = (ring->cycle_state ? 0 : 1);
|
||||||
|
if (!in_interrupt()) {
|
||||||
|
xhci_dbg(xhci, "queue_trb: Toggle cycle "
|
||||||
|
"state for ring %p = %i\n",
|
||||||
|
ring, (unsigned int)ring->cycle_state);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
ring->enq_seg = ring->enq_seg->next;
|
||||||
|
ring->enqueue = ring->enq_seg->trbs;
|
||||||
|
next = ring->enqueue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
Reference in New Issue
Block a user