forked from luck/tmp_suning_uos_patched
usb: renesas_usbhs: modify packet queue control method
Current renesas_usbhs driver is controlling packet queue on mod_gadget.c. But it has relationship with pipe/fifo, not host/gadget. So, controlling USB packet queue in pipe.c/fifo.c is more convenient than in mod_gadget.c. This patch modify it. Signed-off-by: Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
4bd0481152
commit
6acb95d4e0
@ -22,17 +22,40 @@
|
||||
/*
|
||||
* packet info function
|
||||
*/
|
||||
void usbhs_pkt_update(struct usbhs_pkt *pkt,
|
||||
struct usbhs_pipe *pipe,
|
||||
void *buf, int len)
|
||||
void usbhs_pkt_init(struct usbhs_pkt *pkt)
|
||||
{
|
||||
INIT_LIST_HEAD(&pkt->node);
|
||||
}
|
||||
|
||||
void usbhs_pkt_update(struct usbhs_pkt *pkt, void *buf, int len)
|
||||
{
|
||||
pkt->pipe = pipe;
|
||||
pkt->buf = buf;
|
||||
pkt->length = len;
|
||||
pkt->actual = 0;
|
||||
pkt->maxp = 0;
|
||||
}
|
||||
|
||||
void usbhs_pkt_push(struct usbhs_pipe *pipe, struct usbhs_pkt *pkt)
|
||||
{
|
||||
list_del_init(&pkt->node);
|
||||
list_add_tail(&pkt->node, &pipe->list);
|
||||
|
||||
pkt->pipe = pipe;
|
||||
}
|
||||
|
||||
void usbhs_pkt_pop(struct usbhs_pkt *pkt)
|
||||
{
|
||||
list_del_init(&pkt->node);
|
||||
}
|
||||
|
||||
struct usbhs_pkt *usbhs_pkt_get(struct usbhs_pipe *pipe)
|
||||
{
|
||||
if (list_empty(&pipe->list))
|
||||
return NULL;
|
||||
|
||||
return list_entry(pipe->list.next, struct usbhs_pkt, node);
|
||||
}
|
||||
|
||||
/*
|
||||
* FIFO ctrl
|
||||
*/
|
||||
|
@ -20,6 +20,7 @@
|
||||
#include "pipe.h"
|
||||
|
||||
struct usbhs_pkt {
|
||||
struct list_head node;
|
||||
struct usbhs_pipe *pipe;
|
||||
int maxp;
|
||||
void *buf;
|
||||
@ -38,8 +39,10 @@ int usbhs_fifo_prepare_read(struct usbhs_pipe *pipe);
|
||||
/*
|
||||
* packet info
|
||||
*/
|
||||
void usbhs_pkt_update(struct usbhs_pkt *pkt,
|
||||
struct usbhs_pipe *pipe,
|
||||
void *buf, int len);
|
||||
void usbhs_pkt_init(struct usbhs_pkt *pkt);
|
||||
void usbhs_pkt_update(struct usbhs_pkt *pkt, void *buf, int len);
|
||||
void usbhs_pkt_push(struct usbhs_pipe *pipe, struct usbhs_pkt *pkt);
|
||||
void usbhs_pkt_pop(struct usbhs_pkt *pkt);
|
||||
struct usbhs_pkt *usbhs_pkt_get(struct usbhs_pipe *pipe);
|
||||
|
||||
#endif /* RENESAS_USB_FIFO_H */
|
||||
|
@ -26,7 +26,6 @@
|
||||
*/
|
||||
struct usbhsg_request {
|
||||
struct usb_request req;
|
||||
struct list_head node;
|
||||
struct usbhs_pkt pkt;
|
||||
};
|
||||
|
||||
@ -36,7 +35,6 @@ struct usbhsg_pipe_handle;
|
||||
struct usbhsg_uep {
|
||||
struct usb_ep ep;
|
||||
struct usbhs_pipe *pipe;
|
||||
struct list_head list;
|
||||
|
||||
char ep_name[EP_NAME_SIZE];
|
||||
|
||||
@ -161,12 +159,12 @@ static void usbhsg_queue_push(struct usbhsg_uep *uep,
|
||||
struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
|
||||
struct device *dev = usbhsg_gpriv_to_dev(gpriv);
|
||||
struct usbhs_pipe *pipe = usbhsg_uep_to_pipe(uep);
|
||||
struct usbhs_pkt *pkt = usbhsg_ureq_to_pkt(ureq);
|
||||
|
||||
/*
|
||||
********* assume under spin lock *********
|
||||
*/
|
||||
list_del_init(&ureq->node);
|
||||
list_add_tail(&ureq->node, &uep->list);
|
||||
usbhs_pkt_push(pipe, pkt);
|
||||
ureq->req.actual = 0;
|
||||
ureq->req.status = -EINPROGRESS;
|
||||
|
||||
@ -177,13 +175,16 @@ static void usbhsg_queue_push(struct usbhsg_uep *uep,
|
||||
|
||||
static struct usbhsg_request *usbhsg_queue_get(struct usbhsg_uep *uep)
|
||||
{
|
||||
struct usbhs_pipe *pipe = usbhsg_uep_to_pipe(uep);
|
||||
struct usbhs_pkt *pkt = usbhs_pkt_get(pipe);
|
||||
|
||||
/*
|
||||
********* assume under spin lock *********
|
||||
*/
|
||||
if (list_empty(&uep->list))
|
||||
return NULL;
|
||||
if (!pkt)
|
||||
return 0;
|
||||
|
||||
return list_entry(uep->list.next, struct usbhsg_request, node);
|
||||
return usbhsg_pkt_to_ureq(pkt);
|
||||
}
|
||||
|
||||
#define usbhsg_queue_prepare(uep) __usbhsg_queue_handler(uep, 1);
|
||||
@ -243,6 +244,7 @@ static void usbhsg_queue_pop(struct usbhsg_uep *uep,
|
||||
struct usbhsg_gpriv *gpriv = usbhsg_uep_to_gpriv(uep);
|
||||
struct usbhs_pipe *pipe = usbhsg_uep_to_pipe(uep);
|
||||
struct device *dev = usbhsg_gpriv_to_dev(gpriv);
|
||||
struct usbhs_pkt *pkt = usbhsg_ureq_to_pkt(ureq);
|
||||
|
||||
/*
|
||||
********* assume under spin lock *********
|
||||
@ -268,7 +270,7 @@ static void usbhsg_queue_pop(struct usbhsg_uep *uep,
|
||||
|
||||
dev_dbg(dev, "pipe %d : queue pop\n", usbhs_pipe_number(pipe));
|
||||
|
||||
list_del_init(&ureq->node);
|
||||
usbhs_pkt_pop(pkt);
|
||||
|
||||
ureq->req.status = status;
|
||||
ureq->req.complete(&uep->ep, &ureq->req);
|
||||
@ -386,7 +388,6 @@ static void usbhsg_try_run_send_packet_bh(struct usbhs_pkt *pkt)
|
||||
static int usbhsg_try_run_send_packet(struct usbhsg_uep *uep,
|
||||
struct usbhsg_request *ureq)
|
||||
{
|
||||
struct usbhs_pipe *pipe = usbhsg_uep_to_pipe(uep);
|
||||
struct usb_request *req = &ureq->req;
|
||||
struct usbhs_pkt *pkt = usbhsg_ureq_to_pkt(ureq);
|
||||
int ret;
|
||||
@ -395,7 +396,7 @@ static int usbhsg_try_run_send_packet(struct usbhsg_uep *uep,
|
||||
********* assume under spin lock *********
|
||||
*/
|
||||
|
||||
usbhs_pkt_update(pkt, pipe,
|
||||
usbhs_pkt_update(pkt,
|
||||
req->buf + req->actual,
|
||||
req->length - req->actual);
|
||||
|
||||
@ -473,7 +474,6 @@ static void usbhsg_try_run_receive_packet_bh(struct usbhs_pkt *pkt)
|
||||
static int usbhsg_try_run_receive_packet(struct usbhsg_uep *uep,
|
||||
struct usbhsg_request *ureq)
|
||||
{
|
||||
struct usbhs_pipe *pipe = usbhsg_uep_to_pipe(uep);
|
||||
struct usb_request *req = &ureq->req;
|
||||
struct usbhs_pkt *pkt = usbhsg_ureq_to_pkt(ureq);
|
||||
|
||||
@ -481,7 +481,7 @@ static int usbhsg_try_run_receive_packet(struct usbhsg_uep *uep,
|
||||
********* assume under spin lock *********
|
||||
*/
|
||||
|
||||
usbhs_pkt_update(pkt, pipe,
|
||||
usbhs_pkt_update(pkt,
|
||||
req->buf + req->actual,
|
||||
req->length - req->actual);
|
||||
|
||||
@ -814,7 +814,6 @@ static int usbhsg_dcp_enable(struct usbhsg_uep *uep)
|
||||
|
||||
uep->pipe = pipe;
|
||||
uep->pipe->mod_private = uep;
|
||||
INIT_LIST_HEAD(&uep->list);
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -888,7 +887,6 @@ static int usbhsg_ep_enable(struct usb_ep *ep,
|
||||
if (pipe) {
|
||||
uep->pipe = pipe;
|
||||
pipe->mod_private = uep;
|
||||
INIT_LIST_HEAD(&uep->list);
|
||||
|
||||
if (usb_endpoint_dir_in(desc))
|
||||
uep->handler = &usbhsg_handler_send_packet;
|
||||
@ -932,7 +930,8 @@ static struct usb_request *usbhsg_ep_alloc_request(struct usb_ep *ep,
|
||||
if (!ureq)
|
||||
return NULL;
|
||||
|
||||
INIT_LIST_HEAD(&ureq->node);
|
||||
usbhs_pkt_init(usbhsg_ureq_to_pkt(ureq));
|
||||
|
||||
return &ureq->req;
|
||||
}
|
||||
|
||||
@ -941,7 +940,7 @@ static void usbhsg_ep_free_request(struct usb_ep *ep,
|
||||
{
|
||||
struct usbhsg_request *ureq = usbhsg_req_to_ureq(req);
|
||||
|
||||
WARN_ON(!list_empty(&ureq->node));
|
||||
WARN_ON(!list_empty(&ureq->pkt.node));
|
||||
kfree(ureq);
|
||||
}
|
||||
|
||||
@ -1379,7 +1378,6 @@ int __devinit usbhs_mod_gadget_probe(struct usbhs_priv *priv)
|
||||
uep->ep.name = uep->ep_name;
|
||||
uep->ep.ops = &usbhsg_ep_ops;
|
||||
INIT_LIST_HEAD(&uep->ep.ep_list);
|
||||
INIT_LIST_HEAD(&uep->list);
|
||||
|
||||
/* init DCP */
|
||||
if (usbhsg_is_dcp(uep)) {
|
||||
|
@ -558,6 +558,7 @@ void usbhs_pipe_init(struct usbhs_priv *priv,
|
||||
|
||||
usbhsp_flags_init(pipe);
|
||||
pipe->mod_private = NULL;
|
||||
INIT_LIST_HEAD(&pipe->list);
|
||||
|
||||
/* pipe force init */
|
||||
usbhsp_pipectrl_set(pipe, ACLRM, ACLRM);
|
||||
@ -585,6 +586,8 @@ struct usbhs_pipe *usbhs_pipe_malloc(struct usbhs_priv *priv,
|
||||
return NULL;
|
||||
}
|
||||
|
||||
INIT_LIST_HEAD(&pipe->list);
|
||||
|
||||
usbhs_pipe_disable(pipe);
|
||||
|
||||
/* make sure pipe is not busy */
|
||||
@ -632,6 +635,7 @@ struct usbhs_pipe *usbhs_dcp_malloc(struct usbhs_priv *priv)
|
||||
|
||||
usbhsp_pipe_select(pipe);
|
||||
usbhs_pipe_clear_sequence(pipe);
|
||||
INIT_LIST_HEAD(&pipe->list);
|
||||
|
||||
return pipe;
|
||||
}
|
||||
|
@ -27,6 +27,7 @@ struct usbhs_pipe {
|
||||
u32 pipe_type; /* USB_ENDPOINT_XFER_xxx */
|
||||
|
||||
struct usbhs_priv *priv;
|
||||
struct list_head list;
|
||||
|
||||
u32 flags;
|
||||
#define USBHS_PIPE_FLAGS_IS_USED (1 << 0)
|
||||
|
Loading…
Reference in New Issue
Block a user