usb: chipidea: udc: read status of td only once in hardware_dequeue

This patch changes the read of the td status to one atomic operation to
analyse coherent bits.

Signed-off-by: Michael Grzeschik <m.grzeschik@pengutronix.de>
[Alex: fixed backwards endianness conversion]
Signed-off-by: Alexander Shishkin <alexander.shishkin@linux.intel.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
Michael Grzeschik 2013-03-30 12:54:07 +02:00 committed by Greg Kroah-Hartman
parent 776ffc16b7
commit 9e5064384a
1 changed files with 5 additions and 3 deletions

View File

@ -481,10 +481,12 @@ done:
*/ */
static int _hardware_dequeue(struct ci13xxx_ep *mEp, struct ci13xxx_req *mReq) static int _hardware_dequeue(struct ci13xxx_ep *mEp, struct ci13xxx_req *mReq)
{ {
u32 tmptoken = le32_to_cpu(mReq->ptr->token);
if (mReq->req.status != -EALREADY) if (mReq->req.status != -EALREADY)
return -EINVAL; return -EINVAL;
if ((cpu_to_le32(TD_STATUS_ACTIVE) & mReq->ptr->token) != 0) if ((TD_STATUS_ACTIVE & tmptoken) != 0)
return -EBUSY; return -EBUSY;
if (mReq->zptr) { if (mReq->zptr) {
@ -498,7 +500,7 @@ static int _hardware_dequeue(struct ci13xxx_ep *mEp, struct ci13xxx_req *mReq)
usb_gadget_unmap_request(&mEp->ci->gadget, &mReq->req, mEp->dir); usb_gadget_unmap_request(&mEp->ci->gadget, &mReq->req, mEp->dir);
mReq->req.status = le32_to_cpu(mReq->ptr->token) & TD_STATUS; mReq->req.status = tmptoken & TD_STATUS;
if ((TD_STATUS_HALTED & mReq->req.status) != 0) if ((TD_STATUS_HALTED & mReq->req.status) != 0)
mReq->req.status = -1; mReq->req.status = -1;
else if ((TD_STATUS_DT_ERR & mReq->req.status) != 0) else if ((TD_STATUS_DT_ERR & mReq->req.status) != 0)
@ -506,7 +508,7 @@ static int _hardware_dequeue(struct ci13xxx_ep *mEp, struct ci13xxx_req *mReq)
else if ((TD_STATUS_TR_ERR & mReq->req.status) != 0) else if ((TD_STATUS_TR_ERR & mReq->req.status) != 0)
mReq->req.status = -1; mReq->req.status = -1;
mReq->req.actual = le32_to_cpu(mReq->ptr->token) & TD_TOTAL_BYTES; mReq->req.actual = tmptoken & TD_TOTAL_BYTES;
mReq->req.actual >>= __ffs(TD_TOTAL_BYTES); mReq->req.actual >>= __ffs(TD_TOTAL_BYTES);
mReq->req.actual = mReq->req.length - mReq->req.actual; mReq->req.actual = mReq->req.length - mReq->req.actual;
mReq->req.actual = mReq->req.status ? 0 : mReq->req.actual; mReq->req.actual = mReq->req.status ? 0 : mReq->req.actual;