forked from Minki/linux
usb: musb: do not mess up count number and CSR0 register value
Signed-off-by: Bryan Wu <cooloney@kernel.org> Signed-off-by: Felipe Balbi <felipe.balbi@nokia.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
2492e6747f
commit
64ca44a65a
@ -437,7 +437,7 @@ static void ep0_rxstate(struct musb *musb)
|
||||
{
|
||||
void __iomem *regs = musb->control_ep->regs;
|
||||
struct usb_request *req;
|
||||
u16 tmp;
|
||||
u16 count, csr;
|
||||
|
||||
req = next_ep0_request(musb);
|
||||
|
||||
@ -449,35 +449,35 @@ static void ep0_rxstate(struct musb *musb)
|
||||
unsigned len = req->length - req->actual;
|
||||
|
||||
/* read the buffer */
|
||||
tmp = musb_readb(regs, MUSB_COUNT0);
|
||||
if (tmp > len) {
|
||||
count = musb_readb(regs, MUSB_COUNT0);
|
||||
if (count > len) {
|
||||
req->status = -EOVERFLOW;
|
||||
tmp = len;
|
||||
count = len;
|
||||
}
|
||||
musb_read_fifo(&musb->endpoints[0], tmp, buf);
|
||||
req->actual += tmp;
|
||||
tmp = MUSB_CSR0_P_SVDRXPKTRDY;
|
||||
if (tmp < 64 || req->actual == req->length) {
|
||||
musb_read_fifo(&musb->endpoints[0], count, buf);
|
||||
req->actual += count;
|
||||
csr = MUSB_CSR0_P_SVDRXPKTRDY;
|
||||
if (count < 64 || req->actual == req->length) {
|
||||
musb->ep0_state = MUSB_EP0_STAGE_STATUSIN;
|
||||
tmp |= MUSB_CSR0_P_DATAEND;
|
||||
csr |= MUSB_CSR0_P_DATAEND;
|
||||
} else
|
||||
req = NULL;
|
||||
} 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
|
||||
* message just received holds invalid data.
|
||||
*/
|
||||
if (req) {
|
||||
musb->ackpend = tmp;
|
||||
musb->ackpend = csr;
|
||||
musb_g_ep0_giveback(musb, req);
|
||||
if (!musb->ackpend)
|
||||
return;
|
||||
musb->ackpend = 0;
|
||||
}
|
||||
musb_ep_select(musb->mregs, 0);
|
||||
musb_writew(regs, MUSB_CSR0, tmp);
|
||||
musb_writew(regs, MUSB_CSR0, csr);
|
||||
}
|
||||
|
||||
/*
|
||||
|
Loading…
Reference in New Issue
Block a user