usb: renesas_usbhs: fixup fifo disable
It was necessary to check pipe condition after disable fifo. Current driver checked it in a wrong place. Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
committed by
Greg Kroah-Hartman
parent
fd5054c169
commit
c786e09c35
@@ -183,7 +183,6 @@ static void usbhsp_pipe_select(struct usbhs_pipe *pipe)
|
|||||||
static int usbhsp_pipe_barrier(struct usbhs_pipe *pipe)
|
static int usbhsp_pipe_barrier(struct usbhs_pipe *pipe)
|
||||||
{
|
{
|
||||||
struct usbhs_priv *priv = usbhsp_pipe_to_priv(pipe);
|
struct usbhs_priv *priv = usbhsp_pipe_to_priv(pipe);
|
||||||
struct device *dev = usbhs_priv_to_dev(priv);
|
|
||||||
int timeout = 1024;
|
int timeout = 1024;
|
||||||
u16 val;
|
u16 val;
|
||||||
|
|
||||||
@@ -206,6 +205,7 @@ static int usbhsp_pipe_barrier(struct usbhs_pipe *pipe)
|
|||||||
* - "Pipe Control Registers Switching Procedure"
|
* - "Pipe Control Registers Switching Procedure"
|
||||||
*/
|
*/
|
||||||
usbhs_write(priv, CFIFOSEL, 0);
|
usbhs_write(priv, CFIFOSEL, 0);
|
||||||
|
usbhs_fifo_disable(pipe);
|
||||||
|
|
||||||
do {
|
do {
|
||||||
val = usbhsp_pipectrl_get(pipe);
|
val = usbhsp_pipectrl_get(pipe);
|
||||||
@@ -217,21 +217,6 @@ static int usbhsp_pipe_barrier(struct usbhs_pipe *pipe)
|
|||||||
|
|
||||||
} while (timeout--);
|
} while (timeout--);
|
||||||
|
|
||||||
/*
|
|
||||||
* force NAK
|
|
||||||
*/
|
|
||||||
timeout = 1024;
|
|
||||||
usbhs_fifo_disable(pipe);
|
|
||||||
do {
|
|
||||||
val = usbhsp_pipectrl_get(pipe);
|
|
||||||
val &= PBUSY;
|
|
||||||
if (!val)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
} while (timeout--);
|
|
||||||
|
|
||||||
dev_err(dev, "pipe barrier failed\n");
|
|
||||||
|
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -270,10 +255,22 @@ static void __usbhsp_pid_try_nak_if_stall(struct usbhs_pipe *pipe)
|
|||||||
|
|
||||||
void usbhs_fifo_disable(struct usbhs_pipe *pipe)
|
void usbhs_fifo_disable(struct usbhs_pipe *pipe)
|
||||||
{
|
{
|
||||||
|
int timeout = 1024;
|
||||||
|
u16 val;
|
||||||
|
|
||||||
/* see "Pipe n Control Register" - "PID" */
|
/* see "Pipe n Control Register" - "PID" */
|
||||||
__usbhsp_pid_try_nak_if_stall(pipe);
|
__usbhsp_pid_try_nak_if_stall(pipe);
|
||||||
|
|
||||||
usbhsp_pipectrl_set(pipe, PID_MASK, PID_NAK);
|
usbhsp_pipectrl_set(pipe, PID_MASK, PID_NAK);
|
||||||
|
|
||||||
|
do {
|
||||||
|
val = usbhsp_pipectrl_get(pipe);
|
||||||
|
val &= PBUSY;
|
||||||
|
if (!val)
|
||||||
|
break;
|
||||||
|
|
||||||
|
udelay(10);
|
||||||
|
} while (timeout--);
|
||||||
}
|
}
|
||||||
|
|
||||||
void usbhs_fifo_enable(struct usbhs_pipe *pipe)
|
void usbhs_fifo_enable(struct usbhs_pipe *pipe)
|
||||||
|
Reference in New Issue
Block a user