Commit 64ca44a6 authored by Bryan Wu's avatar Bryan Wu Committed by Greg Kroah-Hartman

usb: musb: do not mess up count number and CSR0 register value

Signed-off-by: default avatarBryan Wu <cooloney@kernel.org>
Signed-off-by: default avatarFelipe Balbi <felipe.balbi@nokia.com>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@suse.de>
parent 2492e674
...@@ -437,7 +437,7 @@ static void ep0_rxstate(struct musb *musb) ...@@ -437,7 +437,7 @@ static void ep0_rxstate(struct musb *musb)
{ {
void __iomem *regs = musb->control_ep->regs; void __iomem *regs = musb->control_ep->regs;
struct usb_request *req; struct usb_request *req;
u16 tmp; u16 count, csr;
req = next_ep0_request(musb); req = next_ep0_request(musb);
...@@ -449,35 +449,35 @@ static void ep0_rxstate(struct musb *musb) ...@@ -449,35 +449,35 @@ static void ep0_rxstate(struct musb *musb)
unsigned len = req->length - req->actual; unsigned len = req->length - req->actual;
/* read the buffer */ /* read the buffer */
tmp = musb_readb(regs, MUSB_COUNT0); count = musb_readb(regs, MUSB_COUNT0);
if (tmp > len) { if (count > len) {
req->status = -EOVERFLOW; req->status = -EOVERFLOW;
tmp = len; count = len;
} }
musb_read_fifo(&musb->endpoints[0], tmp, buf); musb_read_fifo(&musb->endpoints[0], count, buf);
req->actual += tmp; req->actual += count;
tmp = MUSB_CSR0_P_SVDRXPKTRDY; csr = MUSB_CSR0_P_SVDRXPKTRDY;
if (tmp < 64 || req->actual == req->length) { if (count < 64 || req->actual == req->length) {
musb->ep0_state = MUSB_EP0_STAGE_STATUSIN; musb->ep0_state = MUSB_EP0_STAGE_STATUSIN;
tmp |= MUSB_CSR0_P_DATAEND; csr |= MUSB_CSR0_P_DATAEND;
} else } else
req = NULL; req = NULL;
} else } else
tmp = MUSB_CSR0_P_SVDRXPKTRDY | MUSB_CSR0_P_SENDSTALL; csr = MUSB_CSR0_P_SVDRXPKTRDY | MUSB_CSR0_P_SENDSTALL;
/* Completion handler may choose to stall, e.g. because the /* Completion handler may choose to stall, e.g. because the
* message just received holds invalid data. * message just received holds invalid data.
*/ */
if (req) { if (req) {
musb->ackpend = tmp; musb->ackpend = csr;
musb_g_ep0_giveback(musb, req); musb_g_ep0_giveback(musb, req);
if (!musb->ackpend) if (!musb->ackpend)
return; return;
musb->ackpend = 0; musb->ackpend = 0;
} }
musb_ep_select(musb->mregs, 0); musb_ep_select(musb->mregs, 0);
musb_writew(regs, MUSB_CSR0, tmp); musb_writew(regs, MUSB_CSR0, csr);
} }
/* /*
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment