35 int ast_vhub_reply(struct ast_vhub_ep *ep, char *ptr, int len)  in ast_vhub_reply()  argument
37 	struct usb_request *req = &ep->ep0.req.req;  in ast_vhub_reply()
40 	if (WARN_ON(ep->d_idx != 0))  in ast_vhub_reply()
42 	if (WARN_ON(!ep->ep0.dir_in))  in ast_vhub_reply()
59 	spin_unlock(&ep->vhub->lock);  in ast_vhub_reply()
60 	if (ep->ep.ops->queue(&ep->ep, req, GFP_ATOMIC))  in ast_vhub_reply()
64 	spin_lock(&ep->vhub->lock);  in ast_vhub_reply()
68 int __ast_vhub_simple_reply(struct ast_vhub_ep *ep, int len, ...)  in __ast_vhub_simple_reply()  argument
70 	u8 *buffer = ep->buf;  in __ast_vhub_simple_reply()
82 	return ast_vhub_reply(ep, NULL, len);  in __ast_vhub_simple_reply()
85 void ast_vhub_ep0_handle_setup(struct ast_vhub_ep *ep)  in ast_vhub_ep0_handle_setup()  argument
91 	if (WARN_ON(ep->d_idx != 0))  in ast_vhub_ep0_handle_setup()
98 	memcpy_fromio(&crq, ep->ep0.setup, sizeof(crq));  in ast_vhub_ep0_handle_setup()
100 	EPDBG(ep, "SETUP packet %02x/%02x/%04x/%04x/%04x [%s] st=%d\n",  in ast_vhub_ep0_handle_setup()
106 	       ep->ep0.state);  in ast_vhub_ep0_handle_setup()
118 	if (ep->ep0.state != ep0_state_token &&  in ast_vhub_ep0_handle_setup()
119 	    ep->ep0.state != ep0_state_stall) {  in ast_vhub_ep0_handle_setup()
120 		EPDBG(ep, "wrong state\n");  in ast_vhub_ep0_handle_setup()
121 		ast_vhub_nuke(ep, -EIO);  in ast_vhub_ep0_handle_setup()
125 	ep->ep0.state = ep0_state_data;  in ast_vhub_ep0_handle_setup()
126 	ep->ep0.dir_in = !!(crq.bRequestType & USB_DIR_IN);  in ast_vhub_ep0_handle_setup()
130 	if (ep->dev == NULL) {  in ast_vhub_ep0_handle_setup()
132 			std_req_rc = ast_vhub_std_hub_request(ep, &crq);  in ast_vhub_ep0_handle_setup()
134 			std_req_rc = ast_vhub_class_hub_request(ep, &crq);  in ast_vhub_ep0_handle_setup()
138 		std_req_rc = ast_vhub_std_dev_request(ep, &crq);  in ast_vhub_ep0_handle_setup()
153 	if (WARN_ON(!ep->dev))  in ast_vhub_ep0_handle_setup()
155 	if (ep->dev->driver) {  in ast_vhub_ep0_handle_setup()
156 		EPDBG(ep, "forwarding to gadget...\n");  in ast_vhub_ep0_handle_setup()
157 		spin_unlock(&ep->vhub->lock);  in ast_vhub_ep0_handle_setup()
158 		rc = ep->dev->driver->setup(&ep->dev->gadget, &crq);  in ast_vhub_ep0_handle_setup()
159 		spin_lock(&ep->vhub->lock);  in ast_vhub_ep0_handle_setup()
160 		EPDBG(ep, "driver returned %d\n", rc);  in ast_vhub_ep0_handle_setup()
162 		EPDBG(ep, "no gadget for request !\n");  in ast_vhub_ep0_handle_setup()
168 	EPDBG(ep, "stalling\n");  in ast_vhub_ep0_handle_setup()
169 	writel(VHUB_EP0_CTRL_STALL, ep->ep0.ctlstat);  in ast_vhub_ep0_handle_setup()
170 	ep->ep0.state = ep0_state_stall;  in ast_vhub_ep0_handle_setup()
171 	ep->ep0.dir_in = false;  in ast_vhub_ep0_handle_setup()
175 	EPVDBG(ep, "sending [in] status with no data\n");  in ast_vhub_ep0_handle_setup()
176 	writel(VHUB_EP0_TX_BUFF_RDY, ep->ep0.ctlstat);  in ast_vhub_ep0_handle_setup()
177 	ep->ep0.state = ep0_state_status;  in ast_vhub_ep0_handle_setup()
178 	ep->ep0.dir_in = false;  in ast_vhub_ep0_handle_setup()
182 static void ast_vhub_ep0_do_send(struct ast_vhub_ep *ep,  in ast_vhub_ep0_do_send()  argument
196 		EPVDBG(ep, "complete send %d/%d\n",  in ast_vhub_ep0_do_send()
198 		ep->ep0.state = ep0_state_status;  in ast_vhub_ep0_do_send()
199 		writel(VHUB_EP0_RX_BUFF_RDY, ep->ep0.ctlstat);  in ast_vhub_ep0_do_send()
200 		ast_vhub_done(ep, req, 0);  in ast_vhub_ep0_do_send()
209 	if (chunk > ep->ep.maxpacket)  in ast_vhub_ep0_do_send()
210 		chunk = ep->ep.maxpacket;  in ast_vhub_ep0_do_send()
211 	else if ((chunk < ep->ep.maxpacket) || !req->req.zero)  in ast_vhub_ep0_do_send()
214 	EPVDBG(ep, "send chunk=%d last=%d, req->act=%d mp=%d\n",  in ast_vhub_ep0_do_send()
215 	       chunk, req->last_desc, req->req.actual, ep->ep.maxpacket);  in ast_vhub_ep0_do_send()
222 		memcpy(ep->buf, req->req.buf + req->req.actual, chunk);  in ast_vhub_ep0_do_send()
224 	vhub_dma_workaround(ep->buf);  in ast_vhub_ep0_do_send()
228 	writel(reg, ep->ep0.ctlstat);  in ast_vhub_ep0_do_send()
229 	writel(reg | VHUB_EP0_TX_BUFF_RDY, ep->ep0.ctlstat);  in ast_vhub_ep0_do_send()
233 static void ast_vhub_ep0_rx_prime(struct ast_vhub_ep *ep)  in ast_vhub_ep0_rx_prime()  argument
235 	EPVDBG(ep, "rx prime\n");  in ast_vhub_ep0_rx_prime()
238 	writel(VHUB_EP0_RX_BUFF_RDY, ep->ep0.ctlstat);  in ast_vhub_ep0_rx_prime()
241 static void ast_vhub_ep0_do_receive(struct ast_vhub_ep *ep, struct ast_vhub_req *req,  in ast_vhub_ep0_do_receive()  argument
250 	EPVDBG(ep, "receive got=%d remain=%d\n", len, remain);  in ast_vhub_ep0_do_receive()
254 		EPDBG(ep, "receiving too much (ovf: %d) !\n",  in ast_vhub_ep0_do_receive()
260 		memcpy(req->req.buf + req->req.actual, ep->buf, len);  in ast_vhub_ep0_do_receive()
264 	if (len < ep->ep.maxpacket || len == remain) {  in ast_vhub_ep0_do_receive()
265 		ep->ep0.state = ep0_state_status;  in ast_vhub_ep0_do_receive()
266 		writel(VHUB_EP0_TX_BUFF_RDY, ep->ep0.ctlstat);  in ast_vhub_ep0_do_receive()
267 		ast_vhub_done(ep, req, rc);  in ast_vhub_ep0_do_receive()
269 		ast_vhub_ep0_rx_prime(ep);  in ast_vhub_ep0_do_receive()
272 void ast_vhub_ep0_handle_ack(struct ast_vhub_ep *ep, bool in_ack)  in ast_vhub_ep0_handle_ack()  argument
275 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_ep0_handle_ack()
281 	stat = readl(ep->ep0.ctlstat);  in ast_vhub_ep0_handle_ack()
284 	req = list_first_entry_or_null(&ep->queue, struct ast_vhub_req, queue);  in ast_vhub_ep0_handle_ack()
286 	EPVDBG(ep, "ACK status=%08x,state=%d is_in=%d in_ack=%d req=%p\n",  in ast_vhub_ep0_handle_ack()
287 		stat, ep->ep0.state, ep->ep0.dir_in, in_ack, req);  in ast_vhub_ep0_handle_ack()
289 	switch(ep->ep0.state) {  in ast_vhub_ep0_handle_ack()
294 			ast_vhub_nuke(ep, -EINVAL);  in ast_vhub_ep0_handle_ack()
301 		if ((ep->ep0.dir_in && (stat & VHUB_EP0_TX_BUFF_RDY)) ||  in ast_vhub_ep0_handle_ack()
302 		    (!ep->ep0.dir_in && (stat & VHUB_EP0_RX_BUFF_RDY)) ||  in ast_vhub_ep0_handle_ack()
303 		    (ep->ep0.dir_in != in_ack)) {  in ast_vhub_ep0_handle_ack()
319 		if (ep->ep0.dir_in)  in ast_vhub_ep0_handle_ack()
320 			ast_vhub_ep0_do_send(ep, req);  in ast_vhub_ep0_handle_ack()
322 			ast_vhub_ep0_do_receive(ep, req, VHUB_EP0_RX_LEN(stat));  in ast_vhub_ep0_handle_ack()
328 			ast_vhub_nuke(ep, -EINVAL);  in ast_vhub_ep0_handle_ack()
336 		if (ep->ep0.dir_in == in_ack) {  in ast_vhub_ep0_handle_ack()
346 		ast_vhub_nuke(ep, -EIO);  in ast_vhub_ep0_handle_ack()
352 		writel(VHUB_EP0_CTRL_STALL, ep->ep0.ctlstat);  in ast_vhub_ep0_handle_ack()
353 		ep->ep0.state = ep0_state_stall;  in ast_vhub_ep0_handle_ack()
355 		ep->ep0.state = ep0_state_token;  in ast_vhub_ep0_handle_ack()
362 	struct ast_vhub_ep *ep = to_ast_ep(u_ep);  in ast_vhub_ep0_queue()  local
363 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_ep0_queue()
378 	if (WARN_ON(ep->d_idx != 0))  in ast_vhub_ep0_queue()
382 	if (ep->dev && !ep->dev->enabled)  in ast_vhub_ep0_queue()
391 	EPVDBG(ep, "enqueue req @%p\n", req);  in ast_vhub_ep0_queue()
392 	EPVDBG(ep, "  l=%d zero=%d noshort=%d is_in=%d\n",  in ast_vhub_ep0_queue()
394 	       u_req->short_not_ok, ep->ep0.dir_in);  in ast_vhub_ep0_queue()
405 	if (!list_empty(&ep->queue) ||  in ast_vhub_ep0_queue()
406 	    ep->ep0.state == ep0_state_token ||  in ast_vhub_ep0_queue()
407 	    ep->ep0.state == ep0_state_stall) {  in ast_vhub_ep0_queue()
409 	        EPVDBG(ep, "EP0: list_empty=%d state=%d\n",  in ast_vhub_ep0_queue()
410 		       list_empty(&ep->queue), ep->ep0.state);  in ast_vhub_ep0_queue()
416 	list_add_tail(&req->queue, &ep->queue);  in ast_vhub_ep0_queue()
418 	if (ep->ep0.dir_in) {  in ast_vhub_ep0_queue()
420 		ast_vhub_ep0_do_send(ep, req);  in ast_vhub_ep0_queue()
423 		EPVDBG(ep, "0-length rx completion\n");  in ast_vhub_ep0_queue()
424 		ep->ep0.state = ep0_state_status;  in ast_vhub_ep0_queue()
425 		writel(VHUB_EP0_TX_BUFF_RDY, ep->ep0.ctlstat);  in ast_vhub_ep0_queue()
426 		ast_vhub_done(ep, req, 0);  in ast_vhub_ep0_queue()
429 		ast_vhub_ep0_rx_prime(ep);  in ast_vhub_ep0_queue()
439 	struct ast_vhub_ep *ep = to_ast_ep(u_ep);  in ast_vhub_ep0_dequeue()  local
440 	struct ast_vhub *vhub = ep->vhub;  in ast_vhub_ep0_dequeue()
448 	req = list_first_entry_or_null(&ep->queue, struct ast_vhub_req, queue);  in ast_vhub_ep0_dequeue()
452 		EPVDBG(ep, "dequeue req @%p\n", req);  in ast_vhub_ep0_dequeue()
458 		ast_vhub_done(ep, req, -ECONNRESET);  in ast_vhub_ep0_dequeue()
461 		writel(VHUB_EP0_CTRL_STALL, ep->ep0.ctlstat);  in ast_vhub_ep0_dequeue()
462 		ep->ep0.state = ep0_state_status;  in ast_vhub_ep0_dequeue()
463 		ep->ep0.dir_in = false;  in ast_vhub_ep0_dequeue()
480 	struct ast_vhub_ep *ep = &dev->ep0;  in ast_vhub_reset_ep0()  local
482 	ast_vhub_nuke(ep, -EIO);  in ast_vhub_reset_ep0()
483 	ep->ep0.state = ep0_state_token;  in ast_vhub_reset_ep0()
487 void ast_vhub_init_ep0(struct ast_vhub *vhub, struct ast_vhub_ep *ep,  in ast_vhub_init_ep0()  argument
490 	memset(ep, 0, sizeof(*ep));  in ast_vhub_init_ep0()
492 	INIT_LIST_HEAD(&ep->ep.ep_list);  in ast_vhub_init_ep0()
493 	INIT_LIST_HEAD(&ep->queue);  in ast_vhub_init_ep0()
494 	ep->ep.ops = &ast_vhub_ep0_ops;  in ast_vhub_init_ep0()
495 	ep->ep.name = "ep0";  in ast_vhub_init_ep0()
496 	ep->ep.caps.type_control = true;  in ast_vhub_init_ep0()
497 	usb_ep_set_maxpacket_limit(&ep->ep, AST_VHUB_EP0_MAX_PACKET);  in ast_vhub_init_ep0()
498 	ep->d_idx = 0;  in ast_vhub_init_ep0()
499 	ep->dev = dev;  in ast_vhub_init_ep0()
500 	ep->vhub = vhub;  in ast_vhub_init_ep0()
501 	ep->ep0.state = ep0_state_token;  in ast_vhub_init_ep0()
502 	INIT_LIST_HEAD(&ep->ep0.req.queue);  in ast_vhub_init_ep0()
503 	ep->ep0.req.internal = true;  in ast_vhub_init_ep0()
507 		ep->ep0.ctlstat = dev->regs + AST_VHUB_DEV_EP0_CTRL;  in ast_vhub_init_ep0()
508 		ep->ep0.setup = vhub->regs +  in ast_vhub_init_ep0()
510 		ep->buf = vhub->ep0_bufs +  in ast_vhub_init_ep0()
512 		ep->buf_dma = vhub->ep0_bufs_dma +  in ast_vhub_init_ep0()
515 		ep->ep0.ctlstat = vhub->regs + AST_VHUB_EP0_CTRL;  in ast_vhub_init_ep0()
516 		ep->ep0.setup = vhub->regs + AST_VHUB_SETUP0;  in ast_vhub_init_ep0()
517 		ep->buf = vhub->ep0_bufs;  in ast_vhub_init_ep0()
518 		ep->buf_dma = vhub->ep0_bufs_dma;  in ast_vhub_init_ep0()