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