15fd54aceSGreg Kroah-Hartman // SPDX-License-Identifier: GPL-1.0+
2034d7c13SKuninori Morimoto /*
3034d7c13SKuninori Morimoto * Renesas USB driver
4034d7c13SKuninori Morimoto *
5034d7c13SKuninori Morimoto * Copyright (C) 2011 Renesas Solutions Corp.
6034d7c13SKuninori Morimoto * Kuninori Morimoto <kuninori.morimoto.gx@renesas.com>
7034d7c13SKuninori Morimoto */
8034d7c13SKuninori Morimoto #include <linux/io.h>
9034d7c13SKuninori Morimoto #include <linux/list.h>
10034d7c13SKuninori Morimoto #include <linux/module.h>
11034d7c13SKuninori Morimoto #include <linux/platform_device.h>
12034d7c13SKuninori Morimoto #include <linux/slab.h>
13034d7c13SKuninori Morimoto #include <linux/usb.h>
14034d7c13SKuninori Morimoto #include <linux/usb/hcd.h>
15034d7c13SKuninori Morimoto #include "common.h"
16034d7c13SKuninori Morimoto
17034d7c13SKuninori Morimoto /*
18034d7c13SKuninori Morimoto *** HARDWARE LIMITATION ***
19034d7c13SKuninori Morimoto *
20034d7c13SKuninori Morimoto * 1) renesas_usbhs has a limited number of controllable devices.
21034d7c13SKuninori Morimoto * it can control only 9 devices in generally.
22034d7c13SKuninori Morimoto * see DEVADDn / DCPMAXP / PIPEMAXP.
23034d7c13SKuninori Morimoto *
24034d7c13SKuninori Morimoto * 2) renesas_usbhs pipe number is limited.
25034d7c13SKuninori Morimoto * the pipe will be re-used for each devices.
26034d7c13SKuninori Morimoto * so, software should control DATA0/1 sequence of each devices.
27034d7c13SKuninori Morimoto */
28034d7c13SKuninori Morimoto
29034d7c13SKuninori Morimoto
30034d7c13SKuninori Morimoto /*
31034d7c13SKuninori Morimoto * image of mod_host
32034d7c13SKuninori Morimoto *
33034d7c13SKuninori Morimoto * +--------+
34034d7c13SKuninori Morimoto * | udev 0 | --> it is used when set address
35034d7c13SKuninori Morimoto * +--------+
36034d7c13SKuninori Morimoto *
37034d7c13SKuninori Morimoto * +--------+ pipes are reused for each uep.
38034d7c13SKuninori Morimoto * | udev 1 |-+- [uep 0 (dcp) ] --+ pipe will be switched when
39e5679d07SKuninori Morimoto * +--------+ | | other device requested
40034d7c13SKuninori Morimoto * +- [uep 1 (bulk)] --|---+ +--------------+
41034d7c13SKuninori Morimoto * | +--------------> | pipe0 (dcp) |
42e5679d07SKuninori Morimoto * +- [uep 2 (bulk)] -@ | +--------------+
43e5679d07SKuninori Morimoto * | | pipe1 (isoc) |
44e5679d07SKuninori Morimoto * +--------+ | +--------------+
45e5679d07SKuninori Morimoto * | udev 2 |-+- [uep 0 (dcp) ] -@ +----------> | pipe2 (bulk) |
46e5679d07SKuninori Morimoto * +--------+ | +--------------+
47e5679d07SKuninori Morimoto * +- [uep 1 (int) ] ----+ +------> | pipe3 (bulk) |
48e5679d07SKuninori Morimoto * | | +--------------+
49e5679d07SKuninori Morimoto * +--------+ +-----|------> | pipe4 (int) |
50e5679d07SKuninori Morimoto * | udev 3 |-+- [uep 0 (dcp) ] -@ | +--------------+
51e5679d07SKuninori Morimoto * +--------+ | | | .... |
52e5679d07SKuninori Morimoto * +- [uep 1 (bulk)] -@ | | .... |
53034d7c13SKuninori Morimoto * | |
54034d7c13SKuninori Morimoto * +- [uep 2 (bulk)]-----------+
55e5679d07SKuninori Morimoto *
56e5679d07SKuninori Morimoto * @ : uep requested free pipe, but all have been used.
57e5679d07SKuninori Morimoto * now it is waiting for free pipe
58034d7c13SKuninori Morimoto */
59034d7c13SKuninori Morimoto
60034d7c13SKuninori Morimoto
61034d7c13SKuninori Morimoto /*
62034d7c13SKuninori Morimoto * struct
63034d7c13SKuninori Morimoto */
64034d7c13SKuninori Morimoto struct usbhsh_request {
65034d7c13SKuninori Morimoto struct urb *urb;
66034d7c13SKuninori Morimoto struct usbhs_pkt pkt;
67034d7c13SKuninori Morimoto };
68034d7c13SKuninori Morimoto
69034d7c13SKuninori Morimoto struct usbhsh_device {
70034d7c13SKuninori Morimoto struct usb_device *usbv;
71034d7c13SKuninori Morimoto struct list_head ep_list_head; /* list of usbhsh_ep */
72034d7c13SKuninori Morimoto };
73034d7c13SKuninori Morimoto
74034d7c13SKuninori Morimoto struct usbhsh_ep {
75e5679d07SKuninori Morimoto struct usbhs_pipe *pipe; /* attached pipe */
76034d7c13SKuninori Morimoto struct usbhsh_device *udev; /* attached udev */
77e4c57dedSKuninori Morimoto struct usb_host_endpoint *ep;
78034d7c13SKuninori Morimoto struct list_head ep_list; /* list to usbhsh_device */
797b332e5fSKuninori Morimoto unsigned int counter; /* pipe attach counter */
80034d7c13SKuninori Morimoto };
81034d7c13SKuninori Morimoto
82034d7c13SKuninori Morimoto #define USBHSH_DEVICE_MAX 10 /* see DEVADDn / DCPMAXP / PIPEMAXP */
83034d7c13SKuninori Morimoto #define USBHSH_PORT_MAX 7 /* see DEVADDn :: HUBPORT */
84034d7c13SKuninori Morimoto struct usbhsh_hpriv {
85034d7c13SKuninori Morimoto struct usbhs_mod mod;
86034d7c13SKuninori Morimoto struct usbhs_pipe *dcp;
87034d7c13SKuninori Morimoto
88034d7c13SKuninori Morimoto struct usbhsh_device udev[USBHSH_DEVICE_MAX];
89034d7c13SKuninori Morimoto
90034d7c13SKuninori Morimoto u32 port_stat; /* USB_PORT_STAT_xxx */
91034d7c13SKuninori Morimoto
927fccd480SKuninori Morimoto struct completion setup_ack_done;
93034d7c13SKuninori Morimoto };
94034d7c13SKuninori Morimoto
95034d7c13SKuninori Morimoto
96034d7c13SKuninori Morimoto static const char usbhsh_hcd_name[] = "renesas_usbhs host";
97034d7c13SKuninori Morimoto
98034d7c13SKuninori Morimoto /*
99034d7c13SKuninori Morimoto * macro
100034d7c13SKuninori Morimoto */
101034d7c13SKuninori Morimoto #define usbhsh_priv_to_hpriv(priv) \
102034d7c13SKuninori Morimoto container_of(usbhs_mod_get(priv, USBHS_HOST), struct usbhsh_hpriv, mod)
103034d7c13SKuninori Morimoto
104034d7c13SKuninori Morimoto #define __usbhsh_for_each_udev(start, pos, h, i) \
105925403f4SKuninori Morimoto for ((i) = start; \
106925403f4SKuninori Morimoto ((i) < USBHSH_DEVICE_MAX) && ((pos) = (h)->udev + (i)); \
107925403f4SKuninori Morimoto (i)++)
108034d7c13SKuninori Morimoto
109034d7c13SKuninori Morimoto #define usbhsh_for_each_udev(pos, hpriv, i) \
110034d7c13SKuninori Morimoto __usbhsh_for_each_udev(1, pos, hpriv, i)
111034d7c13SKuninori Morimoto
112034d7c13SKuninori Morimoto #define usbhsh_for_each_udev_with_dev0(pos, hpriv, i) \
113034d7c13SKuninori Morimoto __usbhsh_for_each_udev(0, pos, hpriv, i)
114034d7c13SKuninori Morimoto
115034d7c13SKuninori Morimoto #define usbhsh_hcd_to_hpriv(h) (struct usbhsh_hpriv *)((h)->hcd_priv)
116034d7c13SKuninori Morimoto #define usbhsh_hcd_to_dev(h) ((h)->self.controller)
117034d7c13SKuninori Morimoto
118034d7c13SKuninori Morimoto #define usbhsh_hpriv_to_priv(h) ((h)->mod.priv)
119034d7c13SKuninori Morimoto #define usbhsh_hpriv_to_dcp(h) ((h)->dcp)
120034d7c13SKuninori Morimoto #define usbhsh_hpriv_to_hcd(h) \
121034d7c13SKuninori Morimoto container_of((void *)h, struct usb_hcd, hcd_priv)
122034d7c13SKuninori Morimoto
123034d7c13SKuninori Morimoto #define usbhsh_ep_to_uep(u) ((u)->hcpriv)
124034d7c13SKuninori Morimoto #define usbhsh_uep_to_pipe(u) ((u)->pipe)
125034d7c13SKuninori Morimoto #define usbhsh_uep_to_udev(u) ((u)->udev)
126e4c57dedSKuninori Morimoto #define usbhsh_uep_to_ep(u) ((u)->ep)
127e4c57dedSKuninori Morimoto
128034d7c13SKuninori Morimoto #define usbhsh_urb_to_ureq(u) ((u)->hcpriv)
129034d7c13SKuninori Morimoto #define usbhsh_urb_to_usbv(u) ((u)->dev)
130034d7c13SKuninori Morimoto
131034d7c13SKuninori Morimoto #define usbhsh_usbv_to_udev(d) dev_get_drvdata(&(d)->dev)
132034d7c13SKuninori Morimoto
133034d7c13SKuninori Morimoto #define usbhsh_udev_to_usbv(h) ((h)->usbv)
134ab142308SKuninori Morimoto #define usbhsh_udev_is_used(h) usbhsh_udev_to_usbv(h)
135034d7c13SKuninori Morimoto
136e5679d07SKuninori Morimoto #define usbhsh_pipe_to_uep(p) ((p)->mod_private)
137034d7c13SKuninori Morimoto
1389c673652SKuninori Morimoto #define usbhsh_device_parent(d) (usbhsh_usbv_to_udev((d)->usbv->parent))
1399c673652SKuninori Morimoto #define usbhsh_device_hubport(d) ((d)->usbv->portnum)
140034d7c13SKuninori Morimoto #define usbhsh_device_number(h, d) ((int)((d) - (h)->udev))
141034d7c13SKuninori Morimoto #define usbhsh_device_nth(h, d) ((h)->udev + d)
142034d7c13SKuninori Morimoto #define usbhsh_device0(h) usbhsh_device_nth(h, 0)
143034d7c13SKuninori Morimoto
144034d7c13SKuninori Morimoto #define usbhsh_port_stat_init(h) ((h)->port_stat = 0)
145034d7c13SKuninori Morimoto #define usbhsh_port_stat_set(h, s) ((h)->port_stat |= (s))
146034d7c13SKuninori Morimoto #define usbhsh_port_stat_clear(h, s) ((h)->port_stat &= ~(s))
147034d7c13SKuninori Morimoto #define usbhsh_port_stat_get(h) ((h)->port_stat)
148034d7c13SKuninori Morimoto
14925234b46SKuninori Morimoto #define usbhsh_pkt_to_ureq(p) \
150034d7c13SKuninori Morimoto container_of((void *)p, struct usbhsh_request, pkt)
151034d7c13SKuninori Morimoto
152034d7c13SKuninori Morimoto /*
153034d7c13SKuninori Morimoto * req alloc/free
154034d7c13SKuninori Morimoto */
usbhsh_ureq_alloc(struct usbhsh_hpriv * hpriv,struct urb * urb,gfp_t mem_flags)15525234b46SKuninori Morimoto static struct usbhsh_request *usbhsh_ureq_alloc(struct usbhsh_hpriv *hpriv,
156034d7c13SKuninori Morimoto struct urb *urb,
157034d7c13SKuninori Morimoto gfp_t mem_flags)
158034d7c13SKuninori Morimoto {
159034d7c13SKuninori Morimoto struct usbhsh_request *ureq;
160034d7c13SKuninori Morimoto
161034d7c13SKuninori Morimoto ureq = kzalloc(sizeof(struct usbhsh_request), mem_flags);
16293b6cb45SWolfram Sang if (!ureq)
163034d7c13SKuninori Morimoto return NULL;
164034d7c13SKuninori Morimoto
165034d7c13SKuninori Morimoto usbhs_pkt_init(&ureq->pkt);
166034d7c13SKuninori Morimoto ureq->urb = urb;
167fc9d5c79SKuninori Morimoto usbhsh_urb_to_ureq(urb) = ureq;
168034d7c13SKuninori Morimoto
169034d7c13SKuninori Morimoto return ureq;
170034d7c13SKuninori Morimoto }
171034d7c13SKuninori Morimoto
usbhsh_ureq_free(struct usbhsh_hpriv * hpriv,struct usbhsh_request * ureq)17225234b46SKuninori Morimoto static void usbhsh_ureq_free(struct usbhsh_hpriv *hpriv,
173034d7c13SKuninori Morimoto struct usbhsh_request *ureq)
174034d7c13SKuninori Morimoto {
175fc9d5c79SKuninori Morimoto usbhsh_urb_to_ureq(ureq->urb) = NULL;
176034d7c13SKuninori Morimoto ureq->urb = NULL;
177034d7c13SKuninori Morimoto
178c5b963f8SKuninori Morimoto kfree(ureq);
179034d7c13SKuninori Morimoto }
180034d7c13SKuninori Morimoto
181034d7c13SKuninori Morimoto /*
182b1930da0SKuninori Morimoto * status
183034d7c13SKuninori Morimoto */
usbhsh_is_running(struct usbhsh_hpriv * hpriv)184b1930da0SKuninori Morimoto static int usbhsh_is_running(struct usbhsh_hpriv *hpriv)
185b1930da0SKuninori Morimoto {
186b1930da0SKuninori Morimoto /*
187b1930da0SKuninori Morimoto * we can decide some device is attached or not
188b1930da0SKuninori Morimoto * by checking mod.irq_attch
189b1930da0SKuninori Morimoto * see
190b1930da0SKuninori Morimoto * usbhsh_irq_attch()
191b1930da0SKuninori Morimoto * usbhsh_irq_dtch()
192b1930da0SKuninori Morimoto */
193b1930da0SKuninori Morimoto return (hpriv->mod.irq_attch == NULL);
194b1930da0SKuninori Morimoto }
195b1930da0SKuninori Morimoto
196b1930da0SKuninori Morimoto /*
197e5679d07SKuninori Morimoto * pipe control
198e4c57dedSKuninori Morimoto */
usbhsh_endpoint_sequence_save(struct usbhsh_hpriv * hpriv,struct urb * urb,struct usbhs_pkt * pkt)1993edeee38SKuninori Morimoto static void usbhsh_endpoint_sequence_save(struct usbhsh_hpriv *hpriv,
2003edeee38SKuninori Morimoto struct urb *urb,
2013edeee38SKuninori Morimoto struct usbhs_pkt *pkt)
2023edeee38SKuninori Morimoto {
2033edeee38SKuninori Morimoto int len = urb->actual_length;
2043edeee38SKuninori Morimoto int maxp = usb_endpoint_maxp(&urb->ep->desc);
2053edeee38SKuninori Morimoto int t = 0;
2063edeee38SKuninori Morimoto
2073edeee38SKuninori Morimoto /* DCP is out of sequence control */
2083edeee38SKuninori Morimoto if (usb_pipecontrol(urb->pipe))
2093edeee38SKuninori Morimoto return;
2103edeee38SKuninori Morimoto
2113edeee38SKuninori Morimoto /*
2123edeee38SKuninori Morimoto * renesas_usbhs pipe has a limitation in a number.
2133edeee38SKuninori Morimoto * So, driver should re-use the limited pipe for each device/endpoint.
2143edeee38SKuninori Morimoto * DATA0/1 sequence should be saved for it.
2153edeee38SKuninori Morimoto * see [image of mod_host]
2163edeee38SKuninori Morimoto * [HARDWARE LIMITATION]
2173edeee38SKuninori Morimoto */
2183edeee38SKuninori Morimoto
2193edeee38SKuninori Morimoto /*
2203edeee38SKuninori Morimoto * next sequence depends on actual_length
2213edeee38SKuninori Morimoto *
2223edeee38SKuninori Morimoto * ex) actual_length = 1147, maxp = 512
2233edeee38SKuninori Morimoto * data0 : 512
2243edeee38SKuninori Morimoto * data1 : 512
2253edeee38SKuninori Morimoto * data0 : 123
2263edeee38SKuninori Morimoto * data1 is the next sequence
2273edeee38SKuninori Morimoto */
2283edeee38SKuninori Morimoto t = len / maxp;
2293edeee38SKuninori Morimoto if (len % maxp)
2303edeee38SKuninori Morimoto t++;
2313edeee38SKuninori Morimoto if (pkt->zero)
2323edeee38SKuninori Morimoto t++;
2333edeee38SKuninori Morimoto t %= 2;
2343edeee38SKuninori Morimoto
2353edeee38SKuninori Morimoto if (t)
2363edeee38SKuninori Morimoto usb_dotoggle(urb->dev,
2373edeee38SKuninori Morimoto usb_pipeendpoint(urb->pipe),
2383edeee38SKuninori Morimoto usb_pipeout(urb->pipe));
2393edeee38SKuninori Morimoto }
2403edeee38SKuninori Morimoto
241e4c57dedSKuninori Morimoto static struct usbhsh_device *usbhsh_device_get(struct usbhsh_hpriv *hpriv,
242e4c57dedSKuninori Morimoto struct urb *urb);
243e5679d07SKuninori Morimoto
usbhsh_pipe_attach(struct usbhsh_hpriv * hpriv,struct urb * urb)244e5679d07SKuninori Morimoto static int usbhsh_pipe_attach(struct usbhsh_hpriv *hpriv,
245e5679d07SKuninori Morimoto struct urb *urb)
246e5679d07SKuninori Morimoto {
247e5679d07SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
248e5679d07SKuninori Morimoto struct usbhsh_ep *uep = usbhsh_ep_to_uep(urb->ep);
249e5679d07SKuninori Morimoto struct usbhsh_device *udev = usbhsh_device_get(hpriv, urb);
250e5679d07SKuninori Morimoto struct usbhs_pipe *pipe;
251e5679d07SKuninori Morimoto struct usb_endpoint_descriptor *desc = &urb->ep->desc;
252e5679d07SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
253e5679d07SKuninori Morimoto unsigned long flags;
254e5679d07SKuninori Morimoto int dir_in_req = !!usb_pipein(urb->pipe);
255e5679d07SKuninori Morimoto int is_dcp = usb_endpoint_xfer_control(desc);
256e5679d07SKuninori Morimoto int i, dir_in;
257e5679d07SKuninori Morimoto int ret = -EBUSY;
258e5679d07SKuninori Morimoto
259e5679d07SKuninori Morimoto /******************** spin lock ********************/
260e5679d07SKuninori Morimoto usbhs_lock(priv, flags);
261e5679d07SKuninori Morimoto
2627b332e5fSKuninori Morimoto /*
2637b332e5fSKuninori Morimoto * if uep has been attached to pipe,
2647b332e5fSKuninori Morimoto * reuse it
2657b332e5fSKuninori Morimoto */
2667b332e5fSKuninori Morimoto if (usbhsh_uep_to_pipe(uep)) {
2677b332e5fSKuninori Morimoto ret = 0;
268e5679d07SKuninori Morimoto goto usbhsh_pipe_attach_done;
269e5679d07SKuninori Morimoto }
270e5679d07SKuninori Morimoto
271e5679d07SKuninori Morimoto usbhs_for_each_pipe_with_dcp(pipe, priv, i) {
272e5679d07SKuninori Morimoto
273e5679d07SKuninori Morimoto /* check pipe type */
274e5679d07SKuninori Morimoto if (!usbhs_pipe_type_is(pipe, usb_endpoint_type(desc)))
275e5679d07SKuninori Morimoto continue;
276e5679d07SKuninori Morimoto
277e5679d07SKuninori Morimoto /* check pipe direction if normal pipe */
278e5679d07SKuninori Morimoto if (!is_dcp) {
279e5679d07SKuninori Morimoto dir_in = !!usbhs_pipe_is_dir_in(pipe);
280e5679d07SKuninori Morimoto if (0 != (dir_in - dir_in_req))
281e5679d07SKuninori Morimoto continue;
282e5679d07SKuninori Morimoto }
283e5679d07SKuninori Morimoto
284e5679d07SKuninori Morimoto /* check pipe is free */
285e5679d07SKuninori Morimoto if (usbhsh_pipe_to_uep(pipe))
286e5679d07SKuninori Morimoto continue;
287e5679d07SKuninori Morimoto
288e5679d07SKuninori Morimoto /*
289e5679d07SKuninori Morimoto * attach pipe to uep
290e5679d07SKuninori Morimoto *
291e5679d07SKuninori Morimoto * usbhs_pipe_config_update() should be called after
292e5679d07SKuninori Morimoto * usbhs_set_device_config()
293e5679d07SKuninori Morimoto * see
294e5679d07SKuninori Morimoto * DCPMAXP/PIPEMAXP
295e5679d07SKuninori Morimoto */
296e5679d07SKuninori Morimoto usbhsh_uep_to_pipe(uep) = pipe;
297e5679d07SKuninori Morimoto usbhsh_pipe_to_uep(pipe) = uep;
298e5679d07SKuninori Morimoto
299e5679d07SKuninori Morimoto usbhs_pipe_config_update(pipe,
300e5679d07SKuninori Morimoto usbhsh_device_number(hpriv, udev),
301e5679d07SKuninori Morimoto usb_endpoint_num(desc),
302e5679d07SKuninori Morimoto usb_endpoint_maxp(desc));
303e5679d07SKuninori Morimoto
304e5679d07SKuninori Morimoto dev_dbg(dev, "%s [%d-%d(%s:%s)]\n", __func__,
305e5679d07SKuninori Morimoto usbhsh_device_number(hpriv, udev),
306e5679d07SKuninori Morimoto usb_endpoint_num(desc),
307e5679d07SKuninori Morimoto usbhs_pipe_name(pipe),
308e5679d07SKuninori Morimoto dir_in_req ? "in" : "out");
309e5679d07SKuninori Morimoto
310e5679d07SKuninori Morimoto ret = 0;
311e5679d07SKuninori Morimoto break;
312e5679d07SKuninori Morimoto }
313e5679d07SKuninori Morimoto
314e5679d07SKuninori Morimoto usbhsh_pipe_attach_done:
3157b332e5fSKuninori Morimoto if (0 == ret)
3167b332e5fSKuninori Morimoto uep->counter++;
3177b332e5fSKuninori Morimoto
318e5679d07SKuninori Morimoto usbhs_unlock(priv, flags);
319e5679d07SKuninori Morimoto /******************** spin unlock ******************/
320e5679d07SKuninori Morimoto
321e5679d07SKuninori Morimoto return ret;
322e5679d07SKuninori Morimoto }
323e5679d07SKuninori Morimoto
usbhsh_pipe_detach(struct usbhsh_hpriv * hpriv,struct usbhsh_ep * uep)324e5679d07SKuninori Morimoto static void usbhsh_pipe_detach(struct usbhsh_hpriv *hpriv,
325e5679d07SKuninori Morimoto struct usbhsh_ep *uep)
326e5679d07SKuninori Morimoto {
327e5679d07SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
328e5679d07SKuninori Morimoto struct usbhs_pipe *pipe;
329e5679d07SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
330e5679d07SKuninori Morimoto unsigned long flags;
331e5679d07SKuninori Morimoto
3324f053a24SKuninori Morimoto if (unlikely(!uep)) {
3334f053a24SKuninori Morimoto dev_err(dev, "no uep\n");
3344f053a24SKuninori Morimoto return;
3354f053a24SKuninori Morimoto }
3364f053a24SKuninori Morimoto
337e5679d07SKuninori Morimoto /******************** spin lock ********************/
338e5679d07SKuninori Morimoto usbhs_lock(priv, flags);
339e5679d07SKuninori Morimoto
340e5679d07SKuninori Morimoto pipe = usbhsh_uep_to_pipe(uep);
341e5679d07SKuninori Morimoto
342e5679d07SKuninori Morimoto if (unlikely(!pipe)) {
343d651b442SColin Ian King dev_err(dev, "uep doesn't have pipe\n");
3447b332e5fSKuninori Morimoto } else if (1 == uep->counter--) { /* last user */
345e5679d07SKuninori Morimoto struct usb_host_endpoint *ep = usbhsh_uep_to_ep(uep);
346e5679d07SKuninori Morimoto struct usbhsh_device *udev = usbhsh_uep_to_udev(uep);
347e5679d07SKuninori Morimoto
348e5679d07SKuninori Morimoto /* detach pipe from uep */
349e5679d07SKuninori Morimoto usbhsh_uep_to_pipe(uep) = NULL;
350e5679d07SKuninori Morimoto usbhsh_pipe_to_uep(pipe) = NULL;
351e5679d07SKuninori Morimoto
352e5679d07SKuninori Morimoto dev_dbg(dev, "%s [%d-%d(%s)]\n", __func__,
353e5679d07SKuninori Morimoto usbhsh_device_number(hpriv, udev),
354e5679d07SKuninori Morimoto usb_endpoint_num(&ep->desc),
355e5679d07SKuninori Morimoto usbhs_pipe_name(pipe));
356e5679d07SKuninori Morimoto }
357e5679d07SKuninori Morimoto
358e5679d07SKuninori Morimoto usbhs_unlock(priv, flags);
359e5679d07SKuninori Morimoto /******************** spin unlock ******************/
360e5679d07SKuninori Morimoto }
361e5679d07SKuninori Morimoto
362e5679d07SKuninori Morimoto /*
363e5679d07SKuninori Morimoto * endpoint control
364e5679d07SKuninori Morimoto */
usbhsh_endpoint_attach(struct usbhsh_hpriv * hpriv,struct urb * urb,gfp_t mem_flags)365e4c57dedSKuninori Morimoto static int usbhsh_endpoint_attach(struct usbhsh_hpriv *hpriv,
366e4c57dedSKuninori Morimoto struct urb *urb,
367e4c57dedSKuninori Morimoto gfp_t mem_flags)
368e4c57dedSKuninori Morimoto {
369e4c57dedSKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
370e4c57dedSKuninori Morimoto struct usbhsh_device *udev = usbhsh_device_get(hpriv, urb);
371e4c57dedSKuninori Morimoto struct usb_host_endpoint *ep = urb->ep;
372e4c57dedSKuninori Morimoto struct usbhsh_ep *uep;
373e4c57dedSKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
374e4c57dedSKuninori Morimoto struct usb_endpoint_descriptor *desc = &ep->desc;
375e4c57dedSKuninori Morimoto unsigned long flags;
376e4c57dedSKuninori Morimoto
377e4c57dedSKuninori Morimoto uep = kzalloc(sizeof(struct usbhsh_ep), mem_flags);
37893b6cb45SWolfram Sang if (!uep)
379e4c57dedSKuninori Morimoto return -ENOMEM;
380e4c57dedSKuninori Morimoto
381e4c57dedSKuninori Morimoto /******************** spin lock ********************/
382e4c57dedSKuninori Morimoto usbhs_lock(priv, flags);
383e4c57dedSKuninori Morimoto
384e4c57dedSKuninori Morimoto /*
385e5679d07SKuninori Morimoto * init endpoint
386e4c57dedSKuninori Morimoto */
3877b332e5fSKuninori Morimoto uep->counter = 0;
388e4c57dedSKuninori Morimoto INIT_LIST_HEAD(&uep->ep_list);
389e4c57dedSKuninori Morimoto list_add_tail(&uep->ep_list, &udev->ep_list_head);
390e4c57dedSKuninori Morimoto
391e4c57dedSKuninori Morimoto usbhsh_uep_to_udev(uep) = udev;
392e4c57dedSKuninori Morimoto usbhsh_uep_to_ep(uep) = ep;
393e4c57dedSKuninori Morimoto usbhsh_ep_to_uep(ep) = uep;
394e4c57dedSKuninori Morimoto
395e5679d07SKuninori Morimoto usbhs_unlock(priv, flags);
396e5679d07SKuninori Morimoto /******************** spin unlock ******************/
397e4c57dedSKuninori Morimoto
398e5679d07SKuninori Morimoto dev_dbg(dev, "%s [%d-%d]\n", __func__,
399e4c57dedSKuninori Morimoto usbhsh_device_number(hpriv, udev),
400e5679d07SKuninori Morimoto usb_endpoint_num(desc));
401e4c57dedSKuninori Morimoto
402e4c57dedSKuninori Morimoto return 0;
403e4c57dedSKuninori Morimoto }
404e4c57dedSKuninori Morimoto
usbhsh_endpoint_detach(struct usbhsh_hpriv * hpriv,struct usb_host_endpoint * ep)405e4c57dedSKuninori Morimoto static void usbhsh_endpoint_detach(struct usbhsh_hpriv *hpriv,
406e4c57dedSKuninori Morimoto struct usb_host_endpoint *ep)
407e4c57dedSKuninori Morimoto {
408e4c57dedSKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
409e4c57dedSKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
410e4c57dedSKuninori Morimoto struct usbhsh_ep *uep = usbhsh_ep_to_uep(ep);
411e4c57dedSKuninori Morimoto unsigned long flags;
412e4c57dedSKuninori Morimoto
413e4c57dedSKuninori Morimoto if (!uep)
414e4c57dedSKuninori Morimoto return;
415e4c57dedSKuninori Morimoto
416e5679d07SKuninori Morimoto dev_dbg(dev, "%s [%d-%d]\n", __func__,
417e4c57dedSKuninori Morimoto usbhsh_device_number(hpriv, usbhsh_uep_to_udev(uep)),
418e5679d07SKuninori Morimoto usb_endpoint_num(&ep->desc));
419e5679d07SKuninori Morimoto
420e5679d07SKuninori Morimoto if (usbhsh_uep_to_pipe(uep))
421e5679d07SKuninori Morimoto usbhsh_pipe_detach(hpriv, uep);
422e4c57dedSKuninori Morimoto
423e4c57dedSKuninori Morimoto /******************** spin lock ********************/
424e4c57dedSKuninori Morimoto usbhs_lock(priv, flags);
425e4c57dedSKuninori Morimoto
426e4c57dedSKuninori Morimoto /* remove this endpoint from udev */
427e4c57dedSKuninori Morimoto list_del_init(&uep->ep_list);
428e4c57dedSKuninori Morimoto
429e4c57dedSKuninori Morimoto usbhsh_uep_to_udev(uep) = NULL;
430e4c57dedSKuninori Morimoto usbhsh_uep_to_ep(uep) = NULL;
431e4c57dedSKuninori Morimoto usbhsh_ep_to_uep(ep) = NULL;
432e4c57dedSKuninori Morimoto
433e4c57dedSKuninori Morimoto usbhs_unlock(priv, flags);
434e4c57dedSKuninori Morimoto /******************** spin unlock ******************/
435e4c57dedSKuninori Morimoto
436e4c57dedSKuninori Morimoto kfree(uep);
437e4c57dedSKuninori Morimoto }
438e4c57dedSKuninori Morimoto
usbhsh_endpoint_detach_all(struct usbhsh_hpriv * hpriv,struct usbhsh_device * udev)439e4c57dedSKuninori Morimoto static void usbhsh_endpoint_detach_all(struct usbhsh_hpriv *hpriv,
440e4c57dedSKuninori Morimoto struct usbhsh_device *udev)
441e4c57dedSKuninori Morimoto {
442e4c57dedSKuninori Morimoto struct usbhsh_ep *uep, *next;
443e4c57dedSKuninori Morimoto
444e4c57dedSKuninori Morimoto list_for_each_entry_safe(uep, next, &udev->ep_list_head, ep_list)
445e4c57dedSKuninori Morimoto usbhsh_endpoint_detach(hpriv, usbhsh_uep_to_ep(uep));
446034d7c13SKuninori Morimoto }
447034d7c13SKuninori Morimoto
448034d7c13SKuninori Morimoto /*
449034d7c13SKuninori Morimoto * device control
450034d7c13SKuninori Morimoto */
usbhsh_connected_to_rhdev(struct usb_hcd * hcd,struct usbhsh_device * udev)4519c673652SKuninori Morimoto static int usbhsh_connected_to_rhdev(struct usb_hcd *hcd,
4529c673652SKuninori Morimoto struct usbhsh_device *udev)
4539c673652SKuninori Morimoto {
4549c673652SKuninori Morimoto struct usb_device *usbv = usbhsh_udev_to_usbv(udev);
4559c673652SKuninori Morimoto
4569c673652SKuninori Morimoto return hcd->self.root_hub == usbv->parent;
4579c673652SKuninori Morimoto }
458034d7c13SKuninori Morimoto
usbhsh_device_has_endpoint(struct usbhsh_device * udev)459034d7c13SKuninori Morimoto static int usbhsh_device_has_endpoint(struct usbhsh_device *udev)
460034d7c13SKuninori Morimoto {
461034d7c13SKuninori Morimoto return !list_empty(&udev->ep_list_head);
462034d7c13SKuninori Morimoto }
463034d7c13SKuninori Morimoto
usbhsh_device_get(struct usbhsh_hpriv * hpriv,struct urb * urb)464c1e4877aSKuninori Morimoto static struct usbhsh_device *usbhsh_device_get(struct usbhsh_hpriv *hpriv,
465c1e4877aSKuninori Morimoto struct urb *urb)
466c1e4877aSKuninori Morimoto {
467c1e4877aSKuninori Morimoto struct usb_device *usbv = usbhsh_urb_to_usbv(urb);
468c1e4877aSKuninori Morimoto struct usbhsh_device *udev = usbhsh_usbv_to_udev(usbv);
469c1e4877aSKuninori Morimoto
470c1e4877aSKuninori Morimoto /* usbhsh_device_attach() is still not called */
471c1e4877aSKuninori Morimoto if (!udev)
472c1e4877aSKuninori Morimoto return NULL;
473c1e4877aSKuninori Morimoto
474c1e4877aSKuninori Morimoto /* if it is device0, return it */
475c1e4877aSKuninori Morimoto if (0 == usb_pipedevice(urb->pipe))
476c1e4877aSKuninori Morimoto return usbhsh_device0(hpriv);
477c1e4877aSKuninori Morimoto
478c1e4877aSKuninori Morimoto /* return attached device */
479c1e4877aSKuninori Morimoto return udev;
480c1e4877aSKuninori Morimoto }
481c1e4877aSKuninori Morimoto
usbhsh_device_attach(struct usbhsh_hpriv * hpriv,struct urb * urb)4827aac8d15SKuninori Morimoto static struct usbhsh_device *usbhsh_device_attach(struct usbhsh_hpriv *hpriv,
483034d7c13SKuninori Morimoto struct urb *urb)
484034d7c13SKuninori Morimoto {
485034d7c13SKuninori Morimoto struct usbhsh_device *udev = NULL;
486c1e4877aSKuninori Morimoto struct usbhsh_device *udev0 = usbhsh_device0(hpriv);
487c1e4877aSKuninori Morimoto struct usbhsh_device *pos;
488034d7c13SKuninori Morimoto struct usb_hcd *hcd = usbhsh_hpriv_to_hcd(hpriv);
489034d7c13SKuninori Morimoto struct device *dev = usbhsh_hcd_to_dev(hcd);
490034d7c13SKuninori Morimoto struct usb_device *usbv = usbhsh_urb_to_usbv(urb);
491034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
492d399f90dSKuninori Morimoto unsigned long flags;
4939c673652SKuninori Morimoto u16 upphub, hubport;
494034d7c13SKuninori Morimoto int i;
495034d7c13SKuninori Morimoto
496034d7c13SKuninori Morimoto /*
497c1e4877aSKuninori Morimoto * This function should be called only while urb is pointing to device0.
498c1e4877aSKuninori Morimoto * It will attach unused usbhsh_device to urb (usbv),
499c1e4877aSKuninori Morimoto * and initialize device0.
500c1e4877aSKuninori Morimoto * You can use usbhsh_device_get() to get "current" udev,
501c1e4877aSKuninori Morimoto * and usbhsh_usbv_to_udev() is for "attached" udev.
502034d7c13SKuninori Morimoto */
503c1e4877aSKuninori Morimoto if (0 != usb_pipedevice(urb->pipe)) {
504c1e4877aSKuninori Morimoto dev_err(dev, "%s fail: urb isn't pointing device0\n", __func__);
505c1e4877aSKuninori Morimoto return NULL;
506034d7c13SKuninori Morimoto }
507034d7c13SKuninori Morimoto
508d399f90dSKuninori Morimoto /******************** spin lock ********************/
509d399f90dSKuninori Morimoto usbhs_lock(priv, flags);
510d399f90dSKuninori Morimoto
511034d7c13SKuninori Morimoto /*
512034d7c13SKuninori Morimoto * find unused device
513034d7c13SKuninori Morimoto */
514ab142308SKuninori Morimoto usbhsh_for_each_udev(pos, hpriv, i) {
515ab142308SKuninori Morimoto if (usbhsh_udev_is_used(pos))
516034d7c13SKuninori Morimoto continue;
517ab142308SKuninori Morimoto udev = pos;
518ab142308SKuninori Morimoto break;
519034d7c13SKuninori Morimoto }
520034d7c13SKuninori Morimoto
521d399f90dSKuninori Morimoto if (udev) {
522034d7c13SKuninori Morimoto /*
523034d7c13SKuninori Morimoto * usbhsh_usbv_to_udev()
524034d7c13SKuninori Morimoto * usbhsh_udev_to_usbv()
525034d7c13SKuninori Morimoto * will be enable
526034d7c13SKuninori Morimoto */
527034d7c13SKuninori Morimoto dev_set_drvdata(&usbv->dev, udev);
528034d7c13SKuninori Morimoto udev->usbv = usbv;
529d399f90dSKuninori Morimoto }
530034d7c13SKuninori Morimoto
531d399f90dSKuninori Morimoto usbhs_unlock(priv, flags);
532d399f90dSKuninori Morimoto /******************** spin unlock ******************/
533d399f90dSKuninori Morimoto
534ab142308SKuninori Morimoto if (!udev) {
535034d7c13SKuninori Morimoto dev_err(dev, "no free usbhsh_device\n");
536034d7c13SKuninori Morimoto return NULL;
537ab142308SKuninori Morimoto }
538034d7c13SKuninori Morimoto
539e4c57dedSKuninori Morimoto if (usbhsh_device_has_endpoint(udev)) {
540034d7c13SKuninori Morimoto dev_warn(dev, "udev have old endpoint\n");
541e4c57dedSKuninori Morimoto usbhsh_endpoint_detach_all(hpriv, udev);
542e4c57dedSKuninori Morimoto }
543034d7c13SKuninori Morimoto
544e4c57dedSKuninori Morimoto if (usbhsh_device_has_endpoint(udev0)) {
545c1e4877aSKuninori Morimoto dev_warn(dev, "udev0 have old endpoint\n");
546e4c57dedSKuninori Morimoto usbhsh_endpoint_detach_all(hpriv, udev0);
547e4c57dedSKuninori Morimoto }
548c1e4877aSKuninori Morimoto
549034d7c13SKuninori Morimoto /* uep will be attached */
550c1e4877aSKuninori Morimoto INIT_LIST_HEAD(&udev0->ep_list_head);
551034d7c13SKuninori Morimoto INIT_LIST_HEAD(&udev->ep_list_head);
552034d7c13SKuninori Morimoto
553c1e4877aSKuninori Morimoto /*
554c1e4877aSKuninori Morimoto * set device0 config
555c1e4877aSKuninori Morimoto */
556c1e4877aSKuninori Morimoto usbhs_set_device_config(priv,
557c1e4877aSKuninori Morimoto 0, 0, 0, usbv->speed);
558c1e4877aSKuninori Morimoto
559c1e4877aSKuninori Morimoto /*
560c1e4877aSKuninori Morimoto * set new device config
561c1e4877aSKuninori Morimoto */
5629c673652SKuninori Morimoto upphub = 0;
5639c673652SKuninori Morimoto hubport = 0;
5649c673652SKuninori Morimoto if (!usbhsh_connected_to_rhdev(hcd, udev)) {
5659c673652SKuninori Morimoto /* if udev is not connected to rhdev, it means parent is Hub */
5669c673652SKuninori Morimoto struct usbhsh_device *parent = usbhsh_device_parent(udev);
5679c673652SKuninori Morimoto
5689c673652SKuninori Morimoto upphub = usbhsh_device_number(hpriv, parent);
5699c673652SKuninori Morimoto hubport = usbhsh_device_hubport(udev);
5709c673652SKuninori Morimoto
5719038a038SColin Ian King dev_dbg(dev, "%s connected to Hub [%d:%d](%p)\n", __func__,
5729c673652SKuninori Morimoto upphub, hubport, parent);
5739c673652SKuninori Morimoto }
5749c673652SKuninori Morimoto
5753dd49268SKuninori Morimoto usbhs_set_device_config(priv,
576034d7c13SKuninori Morimoto usbhsh_device_number(hpriv, udev),
5779c673652SKuninori Morimoto upphub, hubport, usbv->speed);
578034d7c13SKuninori Morimoto
579034d7c13SKuninori Morimoto dev_dbg(dev, "%s [%d](%p)\n", __func__,
580034d7c13SKuninori Morimoto usbhsh_device_number(hpriv, udev), udev);
581034d7c13SKuninori Morimoto
582034d7c13SKuninori Morimoto return udev;
583034d7c13SKuninori Morimoto }
584034d7c13SKuninori Morimoto
usbhsh_device_detach(struct usbhsh_hpriv * hpriv,struct usbhsh_device * udev)5857aac8d15SKuninori Morimoto static void usbhsh_device_detach(struct usbhsh_hpriv *hpriv,
586034d7c13SKuninori Morimoto struct usbhsh_device *udev)
587034d7c13SKuninori Morimoto {
588034d7c13SKuninori Morimoto struct usb_hcd *hcd = usbhsh_hpriv_to_hcd(hpriv);
589d399f90dSKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
590034d7c13SKuninori Morimoto struct device *dev = usbhsh_hcd_to_dev(hcd);
591034d7c13SKuninori Morimoto struct usb_device *usbv = usbhsh_udev_to_usbv(udev);
592d399f90dSKuninori Morimoto unsigned long flags;
593034d7c13SKuninori Morimoto
594034d7c13SKuninori Morimoto dev_dbg(dev, "%s [%d](%p)\n", __func__,
595034d7c13SKuninori Morimoto usbhsh_device_number(hpriv, udev), udev);
596034d7c13SKuninori Morimoto
597e4c57dedSKuninori Morimoto if (usbhsh_device_has_endpoint(udev)) {
598034d7c13SKuninori Morimoto dev_warn(dev, "udev still have endpoint\n");
599e4c57dedSKuninori Morimoto usbhsh_endpoint_detach_all(hpriv, udev);
600e4c57dedSKuninori Morimoto }
601034d7c13SKuninori Morimoto
602c1e4877aSKuninori Morimoto /*
603c1e4877aSKuninori Morimoto * There is nothing to do if it is device0.
604c1e4877aSKuninori Morimoto * see
605c1e4877aSKuninori Morimoto * usbhsh_device_attach()
606c1e4877aSKuninori Morimoto * usbhsh_device_get()
607c1e4877aSKuninori Morimoto */
608c1e4877aSKuninori Morimoto if (0 == usbhsh_device_number(hpriv, udev))
609c1e4877aSKuninori Morimoto return;
610c1e4877aSKuninori Morimoto
611d399f90dSKuninori Morimoto /******************** spin lock ********************/
612d399f90dSKuninori Morimoto usbhs_lock(priv, flags);
613034d7c13SKuninori Morimoto
614034d7c13SKuninori Morimoto /*
615034d7c13SKuninori Morimoto * usbhsh_usbv_to_udev()
616034d7c13SKuninori Morimoto * usbhsh_udev_to_usbv()
617034d7c13SKuninori Morimoto * will be disable
618034d7c13SKuninori Morimoto */
619034d7c13SKuninori Morimoto dev_set_drvdata(&usbv->dev, NULL);
620034d7c13SKuninori Morimoto udev->usbv = NULL;
621034d7c13SKuninori Morimoto
622d399f90dSKuninori Morimoto usbhs_unlock(priv, flags);
623d399f90dSKuninori Morimoto /******************** spin unlock ******************/
624034d7c13SKuninori Morimoto }
625034d7c13SKuninori Morimoto
626034d7c13SKuninori Morimoto /*
627034d7c13SKuninori Morimoto * queue push/pop
628034d7c13SKuninori Morimoto */
usbhsh_queue_done(struct usbhs_priv * priv,struct usbhs_pkt * pkt)629034d7c13SKuninori Morimoto static void usbhsh_queue_done(struct usbhs_priv *priv, struct usbhs_pkt *pkt)
630034d7c13SKuninori Morimoto {
63125234b46SKuninori Morimoto struct usbhsh_request *ureq = usbhsh_pkt_to_ureq(pkt);
632034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
633034d7c13SKuninori Morimoto struct usb_hcd *hcd = usbhsh_hpriv_to_hcd(hpriv);
634034d7c13SKuninori Morimoto struct urb *urb = ureq->urb;
635034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
6366d0376f8SKuninori Morimoto int status = 0;
637034d7c13SKuninori Morimoto
638034d7c13SKuninori Morimoto dev_dbg(dev, "%s\n", __func__);
639034d7c13SKuninori Morimoto
640034d7c13SKuninori Morimoto if (!urb) {
641034d7c13SKuninori Morimoto dev_warn(dev, "pkt doesn't have urb\n");
642034d7c13SKuninori Morimoto return;
643034d7c13SKuninori Morimoto }
644034d7c13SKuninori Morimoto
6456d0376f8SKuninori Morimoto if (!usbhsh_is_running(hpriv))
6466d0376f8SKuninori Morimoto status = -ESHUTDOWN;
6476d0376f8SKuninori Morimoto
648034d7c13SKuninori Morimoto urb->actual_length = pkt->actual;
649034d7c13SKuninori Morimoto
6503edeee38SKuninori Morimoto usbhsh_endpoint_sequence_save(hpriv, urb, pkt);
651e0b64ce6SKuninori Morimoto usbhsh_ureq_free(hpriv, ureq);
652e0b64ce6SKuninori Morimoto
653d9b78f33SKuninori Morimoto usbhsh_pipe_detach(hpriv, usbhsh_ep_to_uep(urb->ep));
654034d7c13SKuninori Morimoto
655034d7c13SKuninori Morimoto usb_hcd_unlink_urb_from_ep(hcd, urb);
6566d0376f8SKuninori Morimoto usb_hcd_giveback_urb(hcd, urb, status);
657034d7c13SKuninori Morimoto }
658034d7c13SKuninori Morimoto
usbhsh_queue_push(struct usb_hcd * hcd,struct urb * urb,gfp_t mem_flags)659034d7c13SKuninori Morimoto static int usbhsh_queue_push(struct usb_hcd *hcd,
660ee8a0bf5SKuninori Morimoto struct urb *urb,
661ee8a0bf5SKuninori Morimoto gfp_t mem_flags)
662034d7c13SKuninori Morimoto {
663ee8a0bf5SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd);
6643eddc9e4SKuninori Morimoto struct usbhsh_ep *uep = usbhsh_ep_to_uep(urb->ep);
6653eddc9e4SKuninori Morimoto struct usbhs_pipe *pipe = usbhsh_uep_to_pipe(uep);
666034d7c13SKuninori Morimoto struct device *dev = usbhsh_hcd_to_dev(hcd);
667ee8a0bf5SKuninori Morimoto struct usbhsh_request *ureq;
668034d7c13SKuninori Morimoto void *buf;
6693edeee38SKuninori Morimoto int len, sequence;
670034d7c13SKuninori Morimoto
671034d7c13SKuninori Morimoto if (usb_pipeisoc(urb->pipe)) {
672034d7c13SKuninori Morimoto dev_err(dev, "pipe iso is not supported now\n");
673034d7c13SKuninori Morimoto return -EIO;
674034d7c13SKuninori Morimoto }
675034d7c13SKuninori Morimoto
676ee8a0bf5SKuninori Morimoto /* this ureq will be freed on usbhsh_queue_done() */
677ee8a0bf5SKuninori Morimoto ureq = usbhsh_ureq_alloc(hpriv, urb, mem_flags);
678ee8a0bf5SKuninori Morimoto if (unlikely(!ureq)) {
679ee8a0bf5SKuninori Morimoto dev_err(dev, "ureq alloc fail\n");
680ee8a0bf5SKuninori Morimoto return -ENOMEM;
681ee8a0bf5SKuninori Morimoto }
682ee8a0bf5SKuninori Morimoto
683034d7c13SKuninori Morimoto if (usb_pipein(urb->pipe))
68487c2905fSKuninori Morimoto pipe->handler = &usbhs_fifo_dma_pop_handler;
685034d7c13SKuninori Morimoto else
68687c2905fSKuninori Morimoto pipe->handler = &usbhs_fifo_dma_push_handler;
687034d7c13SKuninori Morimoto
688034d7c13SKuninori Morimoto buf = (void *)(urb->transfer_buffer + urb->actual_length);
689034d7c13SKuninori Morimoto len = urb->transfer_buffer_length - urb->actual_length;
690034d7c13SKuninori Morimoto
6913edeee38SKuninori Morimoto sequence = usb_gettoggle(urb->dev,
6923edeee38SKuninori Morimoto usb_pipeendpoint(urb->pipe),
6933edeee38SKuninori Morimoto usb_pipeout(urb->pipe));
6943edeee38SKuninori Morimoto
695034d7c13SKuninori Morimoto dev_dbg(dev, "%s\n", __func__);
696ee8a0bf5SKuninori Morimoto usbhs_pkt_push(pipe, &ureq->pkt, usbhsh_queue_done,
6973edeee38SKuninori Morimoto buf, len, (urb->transfer_flags & URB_ZERO_PACKET),
6983edeee38SKuninori Morimoto sequence);
6993edeee38SKuninori Morimoto
700034d7c13SKuninori Morimoto usbhs_pkt_start(pipe);
701034d7c13SKuninori Morimoto
702034d7c13SKuninori Morimoto return 0;
703034d7c13SKuninori Morimoto }
704034d7c13SKuninori Morimoto
usbhsh_queue_force_pop(struct usbhs_priv * priv,struct usbhs_pipe * pipe)7052d833faaSKuninori Morimoto static void usbhsh_queue_force_pop(struct usbhs_priv *priv,
7062d833faaSKuninori Morimoto struct usbhs_pipe *pipe)
7072d833faaSKuninori Morimoto {
7082d833faaSKuninori Morimoto struct usbhs_pkt *pkt;
7092d833faaSKuninori Morimoto
7102d833faaSKuninori Morimoto while (1) {
7112d833faaSKuninori Morimoto pkt = usbhs_pkt_pop(pipe, NULL);
7122d833faaSKuninori Morimoto if (!pkt)
7132d833faaSKuninori Morimoto break;
7142d833faaSKuninori Morimoto
7152d833faaSKuninori Morimoto /*
7162d833faaSKuninori Morimoto * if all packet are gone, usbhsh_endpoint_disable()
7172d833faaSKuninori Morimoto * will be called.
7182d833faaSKuninori Morimoto * then, attached device/endpoint/pipe will be detached
7192d833faaSKuninori Morimoto */
7202d833faaSKuninori Morimoto usbhsh_queue_done(priv, pkt);
7212d833faaSKuninori Morimoto }
7222d833faaSKuninori Morimoto }
7232d833faaSKuninori Morimoto
usbhsh_queue_force_pop_all(struct usbhs_priv * priv)7242d833faaSKuninori Morimoto static void usbhsh_queue_force_pop_all(struct usbhs_priv *priv)
7252d833faaSKuninori Morimoto {
7262d833faaSKuninori Morimoto struct usbhs_pipe *pos;
7272d833faaSKuninori Morimoto int i;
7282d833faaSKuninori Morimoto
7292d833faaSKuninori Morimoto usbhs_for_each_pipe_with_dcp(pos, priv, i)
7302d833faaSKuninori Morimoto usbhsh_queue_force_pop(priv, pos);
7312d833faaSKuninori Morimoto }
7322d833faaSKuninori Morimoto
733034d7c13SKuninori Morimoto /*
734034d7c13SKuninori Morimoto * DCP setup stage
735034d7c13SKuninori Morimoto */
usbhsh_is_request_address(struct urb * urb)736034d7c13SKuninori Morimoto static int usbhsh_is_request_address(struct urb *urb)
737034d7c13SKuninori Morimoto {
73825234b46SKuninori Morimoto struct usb_ctrlrequest *req;
739034d7c13SKuninori Morimoto
74025234b46SKuninori Morimoto req = (struct usb_ctrlrequest *)urb->setup_packet;
741034d7c13SKuninori Morimoto
74225234b46SKuninori Morimoto if ((DeviceOutRequest == req->bRequestType << 8) &&
74325234b46SKuninori Morimoto (USB_REQ_SET_ADDRESS == req->bRequest))
744034d7c13SKuninori Morimoto return 1;
745034d7c13SKuninori Morimoto else
746034d7c13SKuninori Morimoto return 0;
747034d7c13SKuninori Morimoto }
748034d7c13SKuninori Morimoto
usbhsh_setup_stage_packet_push(struct usbhsh_hpriv * hpriv,struct urb * urb,struct usbhs_pipe * pipe)749034d7c13SKuninori Morimoto static void usbhsh_setup_stage_packet_push(struct usbhsh_hpriv *hpriv,
750034d7c13SKuninori Morimoto struct urb *urb,
751034d7c13SKuninori Morimoto struct usbhs_pipe *pipe)
752034d7c13SKuninori Morimoto {
753034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
754034d7c13SKuninori Morimoto struct usb_ctrlrequest req;
755034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
756034d7c13SKuninori Morimoto
757034d7c13SKuninori Morimoto /*
758034d7c13SKuninori Morimoto * wait setup packet ACK
759034d7c13SKuninori Morimoto * see
760034d7c13SKuninori Morimoto * usbhsh_irq_setup_ack()
761034d7c13SKuninori Morimoto * usbhsh_irq_setup_err()
762034d7c13SKuninori Morimoto */
7637fccd480SKuninori Morimoto init_completion(&hpriv->setup_ack_done);
764034d7c13SKuninori Morimoto
765034d7c13SKuninori Morimoto /* copy original request */
766034d7c13SKuninori Morimoto memcpy(&req, urb->setup_packet, sizeof(struct usb_ctrlrequest));
767034d7c13SKuninori Morimoto
768034d7c13SKuninori Morimoto /*
769034d7c13SKuninori Morimoto * renesas_usbhs can not use original usb address.
770034d7c13SKuninori Morimoto * see HARDWARE LIMITATION.
771c1e4877aSKuninori Morimoto * modify usb address here to use attached device.
772c1e4877aSKuninori Morimoto * see usbhsh_device_attach()
773034d7c13SKuninori Morimoto */
774034d7c13SKuninori Morimoto if (usbhsh_is_request_address(urb)) {
775c1e4877aSKuninori Morimoto struct usb_device *usbv = usbhsh_urb_to_usbv(urb);
776c1e4877aSKuninori Morimoto struct usbhsh_device *udev = usbhsh_usbv_to_udev(usbv);
777c1e4877aSKuninori Morimoto
778c1e4877aSKuninori Morimoto /* udev is a attached device */
779c1e4877aSKuninori Morimoto req.wValue = usbhsh_device_number(hpriv, udev);
780034d7c13SKuninori Morimoto dev_dbg(dev, "create new address - %d\n", req.wValue);
781034d7c13SKuninori Morimoto }
782034d7c13SKuninori Morimoto
783034d7c13SKuninori Morimoto /* set request */
784034d7c13SKuninori Morimoto usbhs_usbreq_set_val(priv, &req);
785034d7c13SKuninori Morimoto
786034d7c13SKuninori Morimoto /*
787034d7c13SKuninori Morimoto * wait setup packet ACK
788034d7c13SKuninori Morimoto */
7897fccd480SKuninori Morimoto wait_for_completion(&hpriv->setup_ack_done);
790034d7c13SKuninori Morimoto
791034d7c13SKuninori Morimoto dev_dbg(dev, "%s done\n", __func__);
792034d7c13SKuninori Morimoto }
793034d7c13SKuninori Morimoto
794034d7c13SKuninori Morimoto /*
795034d7c13SKuninori Morimoto * DCP data stage
796034d7c13SKuninori Morimoto */
usbhsh_data_stage_packet_done(struct usbhs_priv * priv,struct usbhs_pkt * pkt)797034d7c13SKuninori Morimoto static void usbhsh_data_stage_packet_done(struct usbhs_priv *priv,
798034d7c13SKuninori Morimoto struct usbhs_pkt *pkt)
799034d7c13SKuninori Morimoto {
80025234b46SKuninori Morimoto struct usbhsh_request *ureq = usbhsh_pkt_to_ureq(pkt);
801034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
802034d7c13SKuninori Morimoto
803034d7c13SKuninori Morimoto /* this ureq was connected to urb when usbhsh_urb_enqueue() */
804034d7c13SKuninori Morimoto
80525234b46SKuninori Morimoto usbhsh_ureq_free(hpriv, ureq);
806034d7c13SKuninori Morimoto }
807034d7c13SKuninori Morimoto
usbhsh_data_stage_packet_push(struct usbhsh_hpriv * hpriv,struct urb * urb,struct usbhs_pipe * pipe,gfp_t mem_flags)808ee8a0bf5SKuninori Morimoto static int usbhsh_data_stage_packet_push(struct usbhsh_hpriv *hpriv,
809034d7c13SKuninori Morimoto struct urb *urb,
810ee8a0bf5SKuninori Morimoto struct usbhs_pipe *pipe,
811ee8a0bf5SKuninori Morimoto gfp_t mem_flags)
812ee8a0bf5SKuninori Morimoto
813034d7c13SKuninori Morimoto {
814034d7c13SKuninori Morimoto struct usbhsh_request *ureq;
815034d7c13SKuninori Morimoto
816ee8a0bf5SKuninori Morimoto /* this ureq will be freed on usbhsh_data_stage_packet_done() */
817ee8a0bf5SKuninori Morimoto ureq = usbhsh_ureq_alloc(hpriv, urb, mem_flags);
818ee8a0bf5SKuninori Morimoto if (unlikely(!ureq))
819ee8a0bf5SKuninori Morimoto return -ENOMEM;
820034d7c13SKuninori Morimoto
821034d7c13SKuninori Morimoto if (usb_pipein(urb->pipe))
822034d7c13SKuninori Morimoto pipe->handler = &usbhs_dcp_data_stage_in_handler;
823034d7c13SKuninori Morimoto else
824034d7c13SKuninori Morimoto pipe->handler = &usbhs_dcp_data_stage_out_handler;
825034d7c13SKuninori Morimoto
826ee8a0bf5SKuninori Morimoto usbhs_pkt_push(pipe, &ureq->pkt,
827034d7c13SKuninori Morimoto usbhsh_data_stage_packet_done,
828034d7c13SKuninori Morimoto urb->transfer_buffer,
829034d7c13SKuninori Morimoto urb->transfer_buffer_length,
8303edeee38SKuninori Morimoto (urb->transfer_flags & URB_ZERO_PACKET),
8313edeee38SKuninori Morimoto -1);
832ee8a0bf5SKuninori Morimoto
833ee8a0bf5SKuninori Morimoto return 0;
834034d7c13SKuninori Morimoto }
835034d7c13SKuninori Morimoto
836034d7c13SKuninori Morimoto /*
837034d7c13SKuninori Morimoto * DCP status stage
838034d7c13SKuninori Morimoto */
usbhsh_status_stage_packet_push(struct usbhsh_hpriv * hpriv,struct urb * urb,struct usbhs_pipe * pipe,gfp_t mem_flags)839ee8a0bf5SKuninori Morimoto static int usbhsh_status_stage_packet_push(struct usbhsh_hpriv *hpriv,
840034d7c13SKuninori Morimoto struct urb *urb,
841ee8a0bf5SKuninori Morimoto struct usbhs_pipe *pipe,
842ee8a0bf5SKuninori Morimoto gfp_t mem_flags)
843034d7c13SKuninori Morimoto {
844034d7c13SKuninori Morimoto struct usbhsh_request *ureq;
845034d7c13SKuninori Morimoto
846ee8a0bf5SKuninori Morimoto /* This ureq will be freed on usbhsh_queue_done() */
847ee8a0bf5SKuninori Morimoto ureq = usbhsh_ureq_alloc(hpriv, urb, mem_flags);
848ee8a0bf5SKuninori Morimoto if (unlikely(!ureq))
849ee8a0bf5SKuninori Morimoto return -ENOMEM;
850034d7c13SKuninori Morimoto
851034d7c13SKuninori Morimoto if (usb_pipein(urb->pipe))
852034d7c13SKuninori Morimoto pipe->handler = &usbhs_dcp_status_stage_in_handler;
853034d7c13SKuninori Morimoto else
854034d7c13SKuninori Morimoto pipe->handler = &usbhs_dcp_status_stage_out_handler;
855034d7c13SKuninori Morimoto
856ee8a0bf5SKuninori Morimoto usbhs_pkt_push(pipe, &ureq->pkt,
857034d7c13SKuninori Morimoto usbhsh_queue_done,
858034d7c13SKuninori Morimoto NULL,
859034d7c13SKuninori Morimoto urb->transfer_buffer_length,
8603edeee38SKuninori Morimoto 0, -1);
861ee8a0bf5SKuninori Morimoto
862ee8a0bf5SKuninori Morimoto return 0;
863034d7c13SKuninori Morimoto }
864034d7c13SKuninori Morimoto
usbhsh_dcp_queue_push(struct usb_hcd * hcd,struct urb * urb,gfp_t mflags)865034d7c13SKuninori Morimoto static int usbhsh_dcp_queue_push(struct usb_hcd *hcd,
866ee8a0bf5SKuninori Morimoto struct urb *urb,
867ee8a0bf5SKuninori Morimoto gfp_t mflags)
868034d7c13SKuninori Morimoto {
869ee8a0bf5SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd);
8703eddc9e4SKuninori Morimoto struct usbhsh_ep *uep = usbhsh_ep_to_uep(urb->ep);
8713eddc9e4SKuninori Morimoto struct usbhs_pipe *pipe = usbhsh_uep_to_pipe(uep);
872034d7c13SKuninori Morimoto struct device *dev = usbhsh_hcd_to_dev(hcd);
873ee8a0bf5SKuninori Morimoto int ret;
874034d7c13SKuninori Morimoto
875034d7c13SKuninori Morimoto dev_dbg(dev, "%s\n", __func__);
876034d7c13SKuninori Morimoto
877034d7c13SKuninori Morimoto /*
878034d7c13SKuninori Morimoto * setup stage
879034d7c13SKuninori Morimoto *
880034d7c13SKuninori Morimoto * usbhsh_send_setup_stage_packet() wait SACK/SIGN
881034d7c13SKuninori Morimoto */
882034d7c13SKuninori Morimoto usbhsh_setup_stage_packet_push(hpriv, urb, pipe);
883034d7c13SKuninori Morimoto
884034d7c13SKuninori Morimoto /*
885034d7c13SKuninori Morimoto * data stage
886034d7c13SKuninori Morimoto *
887034d7c13SKuninori Morimoto * It is pushed only when urb has buffer.
888034d7c13SKuninori Morimoto */
889ee8a0bf5SKuninori Morimoto if (urb->transfer_buffer_length) {
890ee8a0bf5SKuninori Morimoto ret = usbhsh_data_stage_packet_push(hpriv, urb, pipe, mflags);
891ee8a0bf5SKuninori Morimoto if (ret < 0) {
892ee8a0bf5SKuninori Morimoto dev_err(dev, "data stage failed\n");
893ee8a0bf5SKuninori Morimoto return ret;
894ee8a0bf5SKuninori Morimoto }
895ee8a0bf5SKuninori Morimoto }
896034d7c13SKuninori Morimoto
897034d7c13SKuninori Morimoto /*
898034d7c13SKuninori Morimoto * status stage
899034d7c13SKuninori Morimoto */
900ee8a0bf5SKuninori Morimoto ret = usbhsh_status_stage_packet_push(hpriv, urb, pipe, mflags);
901ee8a0bf5SKuninori Morimoto if (ret < 0) {
902ee8a0bf5SKuninori Morimoto dev_err(dev, "status stage failed\n");
903ee8a0bf5SKuninori Morimoto return ret;
904ee8a0bf5SKuninori Morimoto }
905034d7c13SKuninori Morimoto
906034d7c13SKuninori Morimoto /*
907034d7c13SKuninori Morimoto * start pushed packets
908034d7c13SKuninori Morimoto */
909034d7c13SKuninori Morimoto usbhs_pkt_start(pipe);
910034d7c13SKuninori Morimoto
911034d7c13SKuninori Morimoto return 0;
912034d7c13SKuninori Morimoto }
913034d7c13SKuninori Morimoto
914034d7c13SKuninori Morimoto /*
915034d7c13SKuninori Morimoto * dma map functions
916034d7c13SKuninori Morimoto */
usbhsh_dma_map_ctrl(struct device * dma_dev,struct usbhs_pkt * pkt,int map)917c3cdcac7SYoshihiro Shimoda static int usbhsh_dma_map_ctrl(struct device *dma_dev, struct usbhs_pkt *pkt,
918c3cdcac7SYoshihiro Shimoda int map)
919034d7c13SKuninori Morimoto {
92087c2905fSKuninori Morimoto if (map) {
92187c2905fSKuninori Morimoto struct usbhsh_request *ureq = usbhsh_pkt_to_ureq(pkt);
92287c2905fSKuninori Morimoto struct urb *urb = ureq->urb;
92387c2905fSKuninori Morimoto
92487c2905fSKuninori Morimoto /* it can not use scatter/gather */
92587c2905fSKuninori Morimoto if (urb->num_sgs)
92687c2905fSKuninori Morimoto return -EINVAL;
92787c2905fSKuninori Morimoto
92887c2905fSKuninori Morimoto pkt->dma = urb->transfer_dma;
92987c2905fSKuninori Morimoto if (!pkt->dma)
93087c2905fSKuninori Morimoto return -EINVAL;
93187c2905fSKuninori Morimoto }
93287c2905fSKuninori Morimoto
933034d7c13SKuninori Morimoto return 0;
934034d7c13SKuninori Morimoto }
935034d7c13SKuninori Morimoto
936034d7c13SKuninori Morimoto /*
937034d7c13SKuninori Morimoto * for hc_driver
938034d7c13SKuninori Morimoto */
usbhsh_host_start(struct usb_hcd * hcd)939034d7c13SKuninori Morimoto static int usbhsh_host_start(struct usb_hcd *hcd)
940034d7c13SKuninori Morimoto {
941034d7c13SKuninori Morimoto return 0;
942034d7c13SKuninori Morimoto }
943034d7c13SKuninori Morimoto
usbhsh_host_stop(struct usb_hcd * hcd)944034d7c13SKuninori Morimoto static void usbhsh_host_stop(struct usb_hcd *hcd)
945034d7c13SKuninori Morimoto {
946034d7c13SKuninori Morimoto }
947034d7c13SKuninori Morimoto
usbhsh_urb_enqueue(struct usb_hcd * hcd,struct urb * urb,gfp_t mem_flags)948034d7c13SKuninori Morimoto static int usbhsh_urb_enqueue(struct usb_hcd *hcd,
949034d7c13SKuninori Morimoto struct urb *urb,
950034d7c13SKuninori Morimoto gfp_t mem_flags)
951034d7c13SKuninori Morimoto {
952034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd);
953034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
954034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
955034d7c13SKuninori Morimoto struct usb_host_endpoint *ep = urb->ep;
9567aac8d15SKuninori Morimoto struct usbhsh_device *new_udev = NULL;
95773ef635aSKuninori Morimoto int is_dir_in = usb_pipein(urb->pipe);
958034d7c13SKuninori Morimoto int ret;
959034d7c13SKuninori Morimoto
96073ef635aSKuninori Morimoto dev_dbg(dev, "%s (%s)\n", __func__, is_dir_in ? "in" : "out");
961034d7c13SKuninori Morimoto
962b1930da0SKuninori Morimoto if (!usbhsh_is_running(hpriv)) {
963b1930da0SKuninori Morimoto ret = -EIO;
96415a3838bSKuninori Morimoto dev_err(dev, "host is not running\n");
965b1930da0SKuninori Morimoto goto usbhsh_urb_enqueue_error_not_linked;
966b1930da0SKuninori Morimoto }
967b1930da0SKuninori Morimoto
968034d7c13SKuninori Morimoto ret = usb_hcd_link_urb_to_ep(hcd, urb);
96915a3838bSKuninori Morimoto if (ret) {
97015a3838bSKuninori Morimoto dev_err(dev, "urb link failed\n");
971034d7c13SKuninori Morimoto goto usbhsh_urb_enqueue_error_not_linked;
972034d7c13SKuninori Morimoto }
973034d7c13SKuninori Morimoto
974034d7c13SKuninori Morimoto /*
9757aac8d15SKuninori Morimoto * attach udev if needed
976e5679d07SKuninori Morimoto * see [image of mod_host]
977034d7c13SKuninori Morimoto */
978c1e4877aSKuninori Morimoto if (!usbhsh_device_get(hpriv, urb)) {
9797aac8d15SKuninori Morimoto new_udev = usbhsh_device_attach(hpriv, urb);
98037332ee0SKuninori Morimoto if (!new_udev) {
98137332ee0SKuninori Morimoto ret = -EIO;
98215a3838bSKuninori Morimoto dev_err(dev, "device attach failed\n");
983034d7c13SKuninori Morimoto goto usbhsh_urb_enqueue_error_not_linked;
984034d7c13SKuninori Morimoto }
98537332ee0SKuninori Morimoto }
986034d7c13SKuninori Morimoto
987034d7c13SKuninori Morimoto /*
9884825093eSKuninori Morimoto * attach endpoint if needed
989e5679d07SKuninori Morimoto * see [image of mod_host]
990034d7c13SKuninori Morimoto */
9914825093eSKuninori Morimoto if (!usbhsh_ep_to_uep(ep)) {
9924825093eSKuninori Morimoto ret = usbhsh_endpoint_attach(hpriv, urb, mem_flags);
99315a3838bSKuninori Morimoto if (ret < 0) {
99415a3838bSKuninori Morimoto dev_err(dev, "endpoint attach failed\n");
995034d7c13SKuninori Morimoto goto usbhsh_urb_enqueue_error_free_device;
996034d7c13SKuninori Morimoto }
99715a3838bSKuninori Morimoto }
998034d7c13SKuninori Morimoto
999034d7c13SKuninori Morimoto /*
1000e5679d07SKuninori Morimoto * attach pipe to endpoint
1001e5679d07SKuninori Morimoto * see [image of mod_host]
1002034d7c13SKuninori Morimoto */
1003e5679d07SKuninori Morimoto ret = usbhsh_pipe_attach(hpriv, urb);
100415a3838bSKuninori Morimoto if (ret < 0) {
100515a3838bSKuninori Morimoto dev_err(dev, "pipe attach failed\n");
1006034d7c13SKuninori Morimoto goto usbhsh_urb_enqueue_error_free_endpoint;
1007034d7c13SKuninori Morimoto }
1008034d7c13SKuninori Morimoto
1009034d7c13SKuninori Morimoto /*
1010034d7c13SKuninori Morimoto * push packet
1011034d7c13SKuninori Morimoto */
1012034d7c13SKuninori Morimoto if (usb_pipecontrol(urb->pipe))
10133eddc9e4SKuninori Morimoto ret = usbhsh_dcp_queue_push(hcd, urb, mem_flags);
1014034d7c13SKuninori Morimoto else
10153eddc9e4SKuninori Morimoto ret = usbhsh_queue_push(hcd, urb, mem_flags);
1016034d7c13SKuninori Morimoto
1017ee8a0bf5SKuninori Morimoto return ret;
1018034d7c13SKuninori Morimoto
1019034d7c13SKuninori Morimoto usbhsh_urb_enqueue_error_free_endpoint:
1020e5679d07SKuninori Morimoto usbhsh_endpoint_detach(hpriv, ep);
1021034d7c13SKuninori Morimoto usbhsh_urb_enqueue_error_free_device:
1022034d7c13SKuninori Morimoto if (new_udev)
10237aac8d15SKuninori Morimoto usbhsh_device_detach(hpriv, new_udev);
1024034d7c13SKuninori Morimoto usbhsh_urb_enqueue_error_not_linked:
1025034d7c13SKuninori Morimoto
1026034d7c13SKuninori Morimoto dev_dbg(dev, "%s error\n", __func__);
1027034d7c13SKuninori Morimoto
1028034d7c13SKuninori Morimoto return ret;
1029034d7c13SKuninori Morimoto }
1030034d7c13SKuninori Morimoto
usbhsh_urb_dequeue(struct usb_hcd * hcd,struct urb * urb,int status)1031034d7c13SKuninori Morimoto static int usbhsh_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
1032034d7c13SKuninori Morimoto {
1033034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd);
1034034d7c13SKuninori Morimoto struct usbhsh_request *ureq = usbhsh_urb_to_ureq(urb);
1035034d7c13SKuninori Morimoto
1036034d7c13SKuninori Morimoto if (ureq) {
103754796543SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
103854796543SKuninori Morimoto struct usbhs_pkt *pkt = &ureq->pkt;
103954796543SKuninori Morimoto
104054796543SKuninori Morimoto usbhs_pkt_pop(pkt->pipe, pkt);
104154796543SKuninori Morimoto usbhsh_queue_done(priv, pkt);
1042034d7c13SKuninori Morimoto }
1043034d7c13SKuninori Morimoto
1044034d7c13SKuninori Morimoto return 0;
1045034d7c13SKuninori Morimoto }
1046034d7c13SKuninori Morimoto
usbhsh_endpoint_disable(struct usb_hcd * hcd,struct usb_host_endpoint * ep)1047034d7c13SKuninori Morimoto static void usbhsh_endpoint_disable(struct usb_hcd *hcd,
1048034d7c13SKuninori Morimoto struct usb_host_endpoint *ep)
1049034d7c13SKuninori Morimoto {
1050034d7c13SKuninori Morimoto struct usbhsh_ep *uep = usbhsh_ep_to_uep(ep);
1051034d7c13SKuninori Morimoto struct usbhsh_device *udev;
1052034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv;
1053034d7c13SKuninori Morimoto
1054034d7c13SKuninori Morimoto /*
1055034d7c13SKuninori Morimoto * this function might be called manytimes by same hcd/ep
1056fca8ab7eSKuninori Morimoto * in-endpoint == out-endpoint if ep == dcp.
1057034d7c13SKuninori Morimoto */
1058034d7c13SKuninori Morimoto if (!uep)
1059034d7c13SKuninori Morimoto return;
1060034d7c13SKuninori Morimoto
1061034d7c13SKuninori Morimoto udev = usbhsh_uep_to_udev(uep);
1062034d7c13SKuninori Morimoto hpriv = usbhsh_hcd_to_hpriv(hcd);
1063034d7c13SKuninori Morimoto
10644825093eSKuninori Morimoto usbhsh_endpoint_detach(hpriv, ep);
1065034d7c13SKuninori Morimoto
1066034d7c13SKuninori Morimoto /*
1067034d7c13SKuninori Morimoto * if there is no endpoint,
1068034d7c13SKuninori Morimoto * free device
1069034d7c13SKuninori Morimoto */
1070034d7c13SKuninori Morimoto if (!usbhsh_device_has_endpoint(udev))
10717aac8d15SKuninori Morimoto usbhsh_device_detach(hpriv, udev);
1072034d7c13SKuninori Morimoto }
1073034d7c13SKuninori Morimoto
usbhsh_hub_status_data(struct usb_hcd * hcd,char * buf)1074034d7c13SKuninori Morimoto static int usbhsh_hub_status_data(struct usb_hcd *hcd, char *buf)
1075034d7c13SKuninori Morimoto {
1076034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd);
1077034d7c13SKuninori Morimoto int roothub_id = 1; /* only 1 root hub */
1078034d7c13SKuninori Morimoto
1079034d7c13SKuninori Morimoto /*
1080034d7c13SKuninori Morimoto * does port stat was changed ?
1081034d7c13SKuninori Morimoto * check USB_PORT_STAT_C_xxx << 16
1082034d7c13SKuninori Morimoto */
1083034d7c13SKuninori Morimoto if (usbhsh_port_stat_get(hpriv) & 0xFFFF0000)
1084034d7c13SKuninori Morimoto *buf = (1 << roothub_id);
1085034d7c13SKuninori Morimoto else
1086034d7c13SKuninori Morimoto *buf = 0;
1087034d7c13SKuninori Morimoto
1088034d7c13SKuninori Morimoto return !!(*buf);
1089034d7c13SKuninori Morimoto }
1090034d7c13SKuninori Morimoto
__usbhsh_hub_hub_feature(struct usbhsh_hpriv * hpriv,u16 typeReq,u16 wValue,u16 wIndex,char * buf,u16 wLength)1091034d7c13SKuninori Morimoto static int __usbhsh_hub_hub_feature(struct usbhsh_hpriv *hpriv,
1092034d7c13SKuninori Morimoto u16 typeReq, u16 wValue,
1093034d7c13SKuninori Morimoto u16 wIndex, char *buf, u16 wLength)
1094034d7c13SKuninori Morimoto {
1095034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
1096034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1097034d7c13SKuninori Morimoto
1098034d7c13SKuninori Morimoto switch (wValue) {
1099034d7c13SKuninori Morimoto case C_HUB_OVER_CURRENT:
1100034d7c13SKuninori Morimoto case C_HUB_LOCAL_POWER:
1101034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: C_HUB_xx\n", __func__);
1102034d7c13SKuninori Morimoto return 0;
1103034d7c13SKuninori Morimoto }
1104034d7c13SKuninori Morimoto
1105034d7c13SKuninori Morimoto return -EPIPE;
1106034d7c13SKuninori Morimoto }
1107034d7c13SKuninori Morimoto
__usbhsh_hub_port_feature(struct usbhsh_hpriv * hpriv,u16 typeReq,u16 wValue,u16 wIndex,char * buf,u16 wLength)1108034d7c13SKuninori Morimoto static int __usbhsh_hub_port_feature(struct usbhsh_hpriv *hpriv,
1109034d7c13SKuninori Morimoto u16 typeReq, u16 wValue,
1110034d7c13SKuninori Morimoto u16 wIndex, char *buf, u16 wLength)
1111034d7c13SKuninori Morimoto {
1112034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
1113034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1114034d7c13SKuninori Morimoto int enable = (typeReq == SetPortFeature);
1115034d7c13SKuninori Morimoto int speed, i, timeout = 128;
1116034d7c13SKuninori Morimoto int roothub_id = 1; /* only 1 root hub */
1117034d7c13SKuninori Morimoto
1118034d7c13SKuninori Morimoto /* common error */
1119034d7c13SKuninori Morimoto if (wIndex > roothub_id || wLength != 0)
1120034d7c13SKuninori Morimoto return -EPIPE;
1121034d7c13SKuninori Morimoto
1122034d7c13SKuninori Morimoto /* check wValue */
1123034d7c13SKuninori Morimoto switch (wValue) {
1124034d7c13SKuninori Morimoto case USB_PORT_FEAT_POWER:
1125034d7c13SKuninori Morimoto usbhs_vbus_ctrl(priv, enable);
1126034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: USB_PORT_FEAT_POWER\n", __func__);
1127034d7c13SKuninori Morimoto break;
1128034d7c13SKuninori Morimoto
1129034d7c13SKuninori Morimoto case USB_PORT_FEAT_ENABLE:
1130034d7c13SKuninori Morimoto case USB_PORT_FEAT_SUSPEND:
1131034d7c13SKuninori Morimoto case USB_PORT_FEAT_C_ENABLE:
1132034d7c13SKuninori Morimoto case USB_PORT_FEAT_C_SUSPEND:
1133034d7c13SKuninori Morimoto case USB_PORT_FEAT_C_CONNECTION:
1134034d7c13SKuninori Morimoto case USB_PORT_FEAT_C_OVER_CURRENT:
1135034d7c13SKuninori Morimoto case USB_PORT_FEAT_C_RESET:
1136034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: USB_PORT_FEAT_xxx\n", __func__);
1137034d7c13SKuninori Morimoto break;
1138034d7c13SKuninori Morimoto
1139034d7c13SKuninori Morimoto case USB_PORT_FEAT_RESET:
1140034d7c13SKuninori Morimoto if (!enable)
1141034d7c13SKuninori Morimoto break;
1142034d7c13SKuninori Morimoto
1143034d7c13SKuninori Morimoto usbhsh_port_stat_clear(hpriv,
1144034d7c13SKuninori Morimoto USB_PORT_STAT_HIGH_SPEED |
1145034d7c13SKuninori Morimoto USB_PORT_STAT_LOW_SPEED);
1146034d7c13SKuninori Morimoto
11472d833faaSKuninori Morimoto usbhsh_queue_force_pop_all(priv);
11482d833faaSKuninori Morimoto
1149034d7c13SKuninori Morimoto usbhs_bus_send_reset(priv);
1150034d7c13SKuninori Morimoto msleep(20);
1151034d7c13SKuninori Morimoto usbhs_bus_send_sof_enable(priv);
1152034d7c13SKuninori Morimoto
1153034d7c13SKuninori Morimoto for (i = 0; i < timeout ; i++) {
1154034d7c13SKuninori Morimoto switch (usbhs_bus_get_speed(priv)) {
1155034d7c13SKuninori Morimoto case USB_SPEED_LOW:
1156034d7c13SKuninori Morimoto speed = USB_PORT_STAT_LOW_SPEED;
1157034d7c13SKuninori Morimoto goto got_usb_bus_speed;
1158034d7c13SKuninori Morimoto case USB_SPEED_HIGH:
1159034d7c13SKuninori Morimoto speed = USB_PORT_STAT_HIGH_SPEED;
1160034d7c13SKuninori Morimoto goto got_usb_bus_speed;
1161034d7c13SKuninori Morimoto case USB_SPEED_FULL:
1162034d7c13SKuninori Morimoto speed = 0;
1163034d7c13SKuninori Morimoto goto got_usb_bus_speed;
1164034d7c13SKuninori Morimoto }
1165034d7c13SKuninori Morimoto
1166034d7c13SKuninori Morimoto msleep(20);
1167034d7c13SKuninori Morimoto }
1168034d7c13SKuninori Morimoto return -EPIPE;
1169034d7c13SKuninori Morimoto
1170034d7c13SKuninori Morimoto got_usb_bus_speed:
1171034d7c13SKuninori Morimoto usbhsh_port_stat_set(hpriv, speed);
1172034d7c13SKuninori Morimoto usbhsh_port_stat_set(hpriv, USB_PORT_STAT_ENABLE);
1173034d7c13SKuninori Morimoto
1174034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: USB_PORT_FEAT_RESET (speed = %d)\n",
1175034d7c13SKuninori Morimoto __func__, speed);
1176034d7c13SKuninori Morimoto
1177034d7c13SKuninori Morimoto /* status change is not needed */
1178034d7c13SKuninori Morimoto return 0;
1179034d7c13SKuninori Morimoto
1180034d7c13SKuninori Morimoto default:
1181034d7c13SKuninori Morimoto return -EPIPE;
1182034d7c13SKuninori Morimoto }
1183034d7c13SKuninori Morimoto
1184034d7c13SKuninori Morimoto /* set/clear status */
1185034d7c13SKuninori Morimoto if (enable)
1186034d7c13SKuninori Morimoto usbhsh_port_stat_set(hpriv, (1 << wValue));
1187034d7c13SKuninori Morimoto else
1188034d7c13SKuninori Morimoto usbhsh_port_stat_clear(hpriv, (1 << wValue));
1189034d7c13SKuninori Morimoto
1190034d7c13SKuninori Morimoto return 0;
1191034d7c13SKuninori Morimoto }
1192034d7c13SKuninori Morimoto
__usbhsh_hub_get_status(struct usbhsh_hpriv * hpriv,u16 typeReq,u16 wValue,u16 wIndex,char * buf,u16 wLength)1193034d7c13SKuninori Morimoto static int __usbhsh_hub_get_status(struct usbhsh_hpriv *hpriv,
1194034d7c13SKuninori Morimoto u16 typeReq, u16 wValue,
1195034d7c13SKuninori Morimoto u16 wIndex, char *buf, u16 wLength)
1196034d7c13SKuninori Morimoto {
1197034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
1198034d7c13SKuninori Morimoto struct usb_hub_descriptor *desc = (struct usb_hub_descriptor *)buf;
1199034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1200034d7c13SKuninori Morimoto int roothub_id = 1; /* only 1 root hub */
1201034d7c13SKuninori Morimoto
1202034d7c13SKuninori Morimoto switch (typeReq) {
1203034d7c13SKuninori Morimoto case GetHubStatus:
1204034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: GetHubStatus\n", __func__);
1205034d7c13SKuninori Morimoto
1206034d7c13SKuninori Morimoto *buf = 0x00;
1207034d7c13SKuninori Morimoto break;
1208034d7c13SKuninori Morimoto
1209034d7c13SKuninori Morimoto case GetPortStatus:
1210034d7c13SKuninori Morimoto if (wIndex != roothub_id)
1211034d7c13SKuninori Morimoto return -EPIPE;
1212034d7c13SKuninori Morimoto
1213034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: GetPortStatus\n", __func__);
1214034d7c13SKuninori Morimoto *(__le32 *)buf = cpu_to_le32(usbhsh_port_stat_get(hpriv));
1215034d7c13SKuninori Morimoto break;
1216034d7c13SKuninori Morimoto
1217034d7c13SKuninori Morimoto case GetHubDescriptor:
1218b11373deSSergei Shtylyov desc->bDescriptorType = USB_DT_HUB;
1219034d7c13SKuninori Morimoto desc->bHubContrCurrent = 0;
1220034d7c13SKuninori Morimoto desc->bNbrPorts = roothub_id;
1221034d7c13SKuninori Morimoto desc->bDescLength = 9;
1222034d7c13SKuninori Morimoto desc->bPwrOn2PwrGood = 0;
1223a1837d15SSergei Shtylyov desc->wHubCharacteristics =
1224a1837d15SSergei Shtylyov cpu_to_le16(HUB_CHAR_INDV_PORT_LPSM | HUB_CHAR_NO_OCPM);
1225034d7c13SKuninori Morimoto desc->u.hs.DeviceRemovable[0] = (roothub_id << 1);
1226034d7c13SKuninori Morimoto desc->u.hs.DeviceRemovable[1] = ~0;
1227034d7c13SKuninori Morimoto dev_dbg(dev, "%s :: GetHubDescriptor\n", __func__);
1228034d7c13SKuninori Morimoto break;
1229034d7c13SKuninori Morimoto }
1230034d7c13SKuninori Morimoto
1231034d7c13SKuninori Morimoto return 0;
1232034d7c13SKuninori Morimoto }
1233034d7c13SKuninori Morimoto
usbhsh_hub_control(struct usb_hcd * hcd,u16 typeReq,u16 wValue,u16 wIndex,char * buf,u16 wLength)1234034d7c13SKuninori Morimoto static int usbhsh_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
1235034d7c13SKuninori Morimoto u16 wIndex, char *buf, u16 wLength)
1236034d7c13SKuninori Morimoto {
1237034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_hcd_to_hpriv(hcd);
1238034d7c13SKuninori Morimoto struct usbhs_priv *priv = usbhsh_hpriv_to_priv(hpriv);
1239034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1240034d7c13SKuninori Morimoto int ret = -EPIPE;
1241034d7c13SKuninori Morimoto
1242034d7c13SKuninori Morimoto switch (typeReq) {
1243034d7c13SKuninori Morimoto
1244034d7c13SKuninori Morimoto /* Hub Feature */
1245034d7c13SKuninori Morimoto case ClearHubFeature:
1246034d7c13SKuninori Morimoto case SetHubFeature:
1247034d7c13SKuninori Morimoto ret = __usbhsh_hub_hub_feature(hpriv, typeReq,
1248034d7c13SKuninori Morimoto wValue, wIndex, buf, wLength);
1249034d7c13SKuninori Morimoto break;
1250034d7c13SKuninori Morimoto
1251034d7c13SKuninori Morimoto /* Port Feature */
1252034d7c13SKuninori Morimoto case SetPortFeature:
1253034d7c13SKuninori Morimoto case ClearPortFeature:
1254034d7c13SKuninori Morimoto ret = __usbhsh_hub_port_feature(hpriv, typeReq,
1255034d7c13SKuninori Morimoto wValue, wIndex, buf, wLength);
1256034d7c13SKuninori Morimoto break;
1257034d7c13SKuninori Morimoto
1258034d7c13SKuninori Morimoto /* Get status */
1259034d7c13SKuninori Morimoto case GetHubStatus:
1260034d7c13SKuninori Morimoto case GetPortStatus:
1261034d7c13SKuninori Morimoto case GetHubDescriptor:
1262034d7c13SKuninori Morimoto ret = __usbhsh_hub_get_status(hpriv, typeReq,
1263034d7c13SKuninori Morimoto wValue, wIndex, buf, wLength);
1264034d7c13SKuninori Morimoto break;
1265034d7c13SKuninori Morimoto }
1266034d7c13SKuninori Morimoto
1267034d7c13SKuninori Morimoto dev_dbg(dev, "typeReq = %x, ret = %d, port_stat = %x\n",
1268034d7c13SKuninori Morimoto typeReq, ret, usbhsh_port_stat_get(hpriv));
1269034d7c13SKuninori Morimoto
1270034d7c13SKuninori Morimoto return ret;
1271034d7c13SKuninori Morimoto }
1272034d7c13SKuninori Morimoto
usbhsh_bus_nop(struct usb_hcd * hcd)1273e7ae64c7SKuninori Morimoto static int usbhsh_bus_nop(struct usb_hcd *hcd)
1274e7ae64c7SKuninori Morimoto {
1275e7ae64c7SKuninori Morimoto /* nothing to do */
1276e7ae64c7SKuninori Morimoto return 0;
1277e7ae64c7SKuninori Morimoto }
1278e7ae64c7SKuninori Morimoto
127937076e94SJulia Lawall static const struct hc_driver usbhsh_driver = {
1280034d7c13SKuninori Morimoto .description = usbhsh_hcd_name,
1281034d7c13SKuninori Morimoto .hcd_priv_size = sizeof(struct usbhsh_hpriv),
1282034d7c13SKuninori Morimoto
1283034d7c13SKuninori Morimoto /*
1284034d7c13SKuninori Morimoto * generic hardware linkage
1285034d7c13SKuninori Morimoto */
12867b81cb6bSChristoph Hellwig .flags = HCD_DMA | HCD_USB2,
1287034d7c13SKuninori Morimoto
1288034d7c13SKuninori Morimoto .start = usbhsh_host_start,
1289034d7c13SKuninori Morimoto .stop = usbhsh_host_stop,
1290034d7c13SKuninori Morimoto
1291034d7c13SKuninori Morimoto /*
1292034d7c13SKuninori Morimoto * managing i/o requests and associated device resources
1293034d7c13SKuninori Morimoto */
1294034d7c13SKuninori Morimoto .urb_enqueue = usbhsh_urb_enqueue,
1295034d7c13SKuninori Morimoto .urb_dequeue = usbhsh_urb_dequeue,
1296034d7c13SKuninori Morimoto .endpoint_disable = usbhsh_endpoint_disable,
1297034d7c13SKuninori Morimoto
1298034d7c13SKuninori Morimoto /*
1299034d7c13SKuninori Morimoto * root hub
1300034d7c13SKuninori Morimoto */
1301034d7c13SKuninori Morimoto .hub_status_data = usbhsh_hub_status_data,
1302034d7c13SKuninori Morimoto .hub_control = usbhsh_hub_control,
1303e7ae64c7SKuninori Morimoto .bus_suspend = usbhsh_bus_nop,
1304e7ae64c7SKuninori Morimoto .bus_resume = usbhsh_bus_nop,
1305034d7c13SKuninori Morimoto };
1306034d7c13SKuninori Morimoto
1307034d7c13SKuninori Morimoto /*
1308034d7c13SKuninori Morimoto * interrupt functions
1309034d7c13SKuninori Morimoto */
usbhsh_irq_attch(struct usbhs_priv * priv,struct usbhs_irq_state * irq_state)1310034d7c13SKuninori Morimoto static int usbhsh_irq_attch(struct usbhs_priv *priv,
1311034d7c13SKuninori Morimoto struct usbhs_irq_state *irq_state)
1312034d7c13SKuninori Morimoto {
1313034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1314034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1315034d7c13SKuninori Morimoto
1316034d7c13SKuninori Morimoto dev_dbg(dev, "device attached\n");
1317034d7c13SKuninori Morimoto
1318034d7c13SKuninori Morimoto usbhsh_port_stat_set(hpriv, USB_PORT_STAT_CONNECTION);
1319034d7c13SKuninori Morimoto usbhsh_port_stat_set(hpriv, USB_PORT_STAT_C_CONNECTION << 16);
1320034d7c13SKuninori Morimoto
132131e00fd1SKuninori Morimoto /*
132231e00fd1SKuninori Morimoto * attch interrupt might happen infinitely on some device
132331e00fd1SKuninori Morimoto * (on self power USB hub ?)
132431e00fd1SKuninori Morimoto * disable it here.
1325b1930da0SKuninori Morimoto *
1326b1930da0SKuninori Morimoto * usbhsh_is_running() becomes effective
1327b1930da0SKuninori Morimoto * according to this process.
1328b1930da0SKuninori Morimoto * see
1329b1930da0SKuninori Morimoto * usbhsh_is_running()
1330b1930da0SKuninori Morimoto * usbhsh_urb_enqueue()
133131e00fd1SKuninori Morimoto */
133231e00fd1SKuninori Morimoto hpriv->mod.irq_attch = NULL;
133331e00fd1SKuninori Morimoto usbhs_irq_callback_update(priv, &hpriv->mod);
133431e00fd1SKuninori Morimoto
1335034d7c13SKuninori Morimoto return 0;
1336034d7c13SKuninori Morimoto }
1337034d7c13SKuninori Morimoto
usbhsh_irq_dtch(struct usbhs_priv * priv,struct usbhs_irq_state * irq_state)1338034d7c13SKuninori Morimoto static int usbhsh_irq_dtch(struct usbhs_priv *priv,
1339034d7c13SKuninori Morimoto struct usbhs_irq_state *irq_state)
1340034d7c13SKuninori Morimoto {
1341034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1342034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1343034d7c13SKuninori Morimoto
1344034d7c13SKuninori Morimoto dev_dbg(dev, "device detached\n");
1345034d7c13SKuninori Morimoto
1346034d7c13SKuninori Morimoto usbhsh_port_stat_clear(hpriv, USB_PORT_STAT_CONNECTION);
1347034d7c13SKuninori Morimoto usbhsh_port_stat_set(hpriv, USB_PORT_STAT_C_CONNECTION << 16);
1348034d7c13SKuninori Morimoto
134931e00fd1SKuninori Morimoto /*
135031e00fd1SKuninori Morimoto * enable attch interrupt again
1351b1930da0SKuninori Morimoto *
1352b1930da0SKuninori Morimoto * usbhsh_is_running() becomes invalid
1353b1930da0SKuninori Morimoto * according to this process.
1354b1930da0SKuninori Morimoto * see
1355b1930da0SKuninori Morimoto * usbhsh_is_running()
1356b1930da0SKuninori Morimoto * usbhsh_urb_enqueue()
135731e00fd1SKuninori Morimoto */
135831e00fd1SKuninori Morimoto hpriv->mod.irq_attch = usbhsh_irq_attch;
135931e00fd1SKuninori Morimoto usbhs_irq_callback_update(priv, &hpriv->mod);
136031e00fd1SKuninori Morimoto
13612d833faaSKuninori Morimoto /*
13622d833faaSKuninori Morimoto * usbhsh_queue_force_pop_all() should be called
13632d833faaSKuninori Morimoto * after usbhsh_is_running() becomes invalid.
13642d833faaSKuninori Morimoto */
13652d833faaSKuninori Morimoto usbhsh_queue_force_pop_all(priv);
13662d833faaSKuninori Morimoto
1367034d7c13SKuninori Morimoto return 0;
1368034d7c13SKuninori Morimoto }
1369034d7c13SKuninori Morimoto
usbhsh_irq_setup_ack(struct usbhs_priv * priv,struct usbhs_irq_state * irq_state)1370034d7c13SKuninori Morimoto static int usbhsh_irq_setup_ack(struct usbhs_priv *priv,
1371034d7c13SKuninori Morimoto struct usbhs_irq_state *irq_state)
1372034d7c13SKuninori Morimoto {
1373034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1374034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1375034d7c13SKuninori Morimoto
1376034d7c13SKuninori Morimoto dev_dbg(dev, "setup packet OK\n");
1377034d7c13SKuninori Morimoto
13787fccd480SKuninori Morimoto complete(&hpriv->setup_ack_done); /* see usbhsh_urb_enqueue() */
1379034d7c13SKuninori Morimoto
1380034d7c13SKuninori Morimoto return 0;
1381034d7c13SKuninori Morimoto }
1382034d7c13SKuninori Morimoto
usbhsh_irq_setup_err(struct usbhs_priv * priv,struct usbhs_irq_state * irq_state)1383034d7c13SKuninori Morimoto static int usbhsh_irq_setup_err(struct usbhs_priv *priv,
1384034d7c13SKuninori Morimoto struct usbhs_irq_state *irq_state)
1385034d7c13SKuninori Morimoto {
1386034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1387034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1388034d7c13SKuninori Morimoto
1389034d7c13SKuninori Morimoto dev_dbg(dev, "setup packet Err\n");
1390034d7c13SKuninori Morimoto
13917fccd480SKuninori Morimoto complete(&hpriv->setup_ack_done); /* see usbhsh_urb_enqueue() */
1392034d7c13SKuninori Morimoto
1393034d7c13SKuninori Morimoto return 0;
1394034d7c13SKuninori Morimoto }
1395034d7c13SKuninori Morimoto
1396034d7c13SKuninori Morimoto /*
1397034d7c13SKuninori Morimoto * module start/stop
1398034d7c13SKuninori Morimoto */
usbhsh_pipe_init_for_host(struct usbhs_priv * priv)1399034d7c13SKuninori Morimoto static void usbhsh_pipe_init_for_host(struct usbhs_priv *priv)
1400034d7c13SKuninori Morimoto {
1401034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1402034d7c13SKuninori Morimoto struct usbhs_pipe *pipe;
140351f141a9SYoshihiro Shimoda struct renesas_usbhs_driver_pipe_config *pipe_configs =
140451f141a9SYoshihiro Shimoda usbhs_get_dparam(priv, pipe_configs);
1405034d7c13SKuninori Morimoto int pipe_size = usbhs_get_dparam(priv, pipe_size);
1406034d7c13SKuninori Morimoto int old_type, dir_in, i;
1407034d7c13SKuninori Morimoto
1408034d7c13SKuninori Morimoto /* init all pipe */
1409034d7c13SKuninori Morimoto old_type = USB_ENDPOINT_XFER_CONTROL;
1410034d7c13SKuninori Morimoto for (i = 0; i < pipe_size; i++) {
1411034d7c13SKuninori Morimoto
1412034d7c13SKuninori Morimoto /*
1413034d7c13SKuninori Morimoto * data "output" will be finished as soon as possible,
1414034d7c13SKuninori Morimoto * but there is no guaranty at data "input" case.
1415034d7c13SKuninori Morimoto *
1416034d7c13SKuninori Morimoto * "input" needs "standby" pipe.
1417034d7c13SKuninori Morimoto * So, "input" direction pipe > "output" direction pipe
1418034d7c13SKuninori Morimoto * is good idea.
1419034d7c13SKuninori Morimoto *
1420034d7c13SKuninori Morimoto * 1st USB_ENDPOINT_XFER_xxx will be output direction,
1421034d7c13SKuninori Morimoto * and the other will be input direction here.
1422034d7c13SKuninori Morimoto *
1423034d7c13SKuninori Morimoto * ex)
1424034d7c13SKuninori Morimoto * ...
1425034d7c13SKuninori Morimoto * USB_ENDPOINT_XFER_ISOC -> dir out
1426034d7c13SKuninori Morimoto * USB_ENDPOINT_XFER_ISOC -> dir in
1427034d7c13SKuninori Morimoto * USB_ENDPOINT_XFER_BULK -> dir out
1428034d7c13SKuninori Morimoto * USB_ENDPOINT_XFER_BULK -> dir in
1429034d7c13SKuninori Morimoto * USB_ENDPOINT_XFER_BULK -> dir in
1430034d7c13SKuninori Morimoto * ...
1431034d7c13SKuninori Morimoto */
143251f141a9SYoshihiro Shimoda dir_in = (pipe_configs[i].type == old_type);
143351f141a9SYoshihiro Shimoda old_type = pipe_configs[i].type;
1434034d7c13SKuninori Morimoto
143551f141a9SYoshihiro Shimoda if (USB_ENDPOINT_XFER_CONTROL == pipe_configs[i].type) {
1436034d7c13SKuninori Morimoto pipe = usbhs_dcp_malloc(priv);
1437034d7c13SKuninori Morimoto usbhsh_hpriv_to_dcp(hpriv) = pipe;
1438034d7c13SKuninori Morimoto } else {
1439034d7c13SKuninori Morimoto pipe = usbhs_pipe_malloc(priv,
144051f141a9SYoshihiro Shimoda pipe_configs[i].type,
1441034d7c13SKuninori Morimoto dir_in);
1442034d7c13SKuninori Morimoto }
1443034d7c13SKuninori Morimoto
1444e5679d07SKuninori Morimoto pipe->mod_private = NULL;
1445034d7c13SKuninori Morimoto }
1446034d7c13SKuninori Morimoto }
1447034d7c13SKuninori Morimoto
usbhsh_start(struct usbhs_priv * priv)1448034d7c13SKuninori Morimoto static int usbhsh_start(struct usbhs_priv *priv)
1449034d7c13SKuninori Morimoto {
1450034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1451034d7c13SKuninori Morimoto struct usb_hcd *hcd = usbhsh_hpriv_to_hcd(hpriv);
1452034d7c13SKuninori Morimoto struct usbhs_mod *mod = usbhs_mod_get_current(priv);
1453034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1454034d7c13SKuninori Morimoto int ret;
1455034d7c13SKuninori Morimoto
1456034d7c13SKuninori Morimoto /* add hcd */
1457034d7c13SKuninori Morimoto ret = usb_add_hcd(hcd, 0, 0);
1458034d7c13SKuninori Morimoto if (ret < 0)
1459034d7c13SKuninori Morimoto return 0;
14603c9740a1SPeter Chen device_wakeup_enable(hcd->self.controller);
1461034d7c13SKuninori Morimoto
1462034d7c13SKuninori Morimoto /*
1463034d7c13SKuninori Morimoto * pipe initialize and enable DCP
1464034d7c13SKuninori Morimoto */
1465cdeb7943SYoshihiro Shimoda usbhs_fifo_init(priv);
1466034d7c13SKuninori Morimoto usbhs_pipe_init(priv,
1467034d7c13SKuninori Morimoto usbhsh_dma_map_ctrl);
1468034d7c13SKuninori Morimoto usbhsh_pipe_init_for_host(priv);
1469034d7c13SKuninori Morimoto
1470034d7c13SKuninori Morimoto /*
1471034d7c13SKuninori Morimoto * system config enble
1472034d7c13SKuninori Morimoto * - HI speed
1473034d7c13SKuninori Morimoto * - host
1474034d7c13SKuninori Morimoto * - usb module
1475034d7c13SKuninori Morimoto */
1476034d7c13SKuninori Morimoto usbhs_sys_host_ctrl(priv, 1);
1477034d7c13SKuninori Morimoto
1478034d7c13SKuninori Morimoto /*
1479034d7c13SKuninori Morimoto * enable irq callback
1480034d7c13SKuninori Morimoto */
1481034d7c13SKuninori Morimoto mod->irq_attch = usbhsh_irq_attch;
1482034d7c13SKuninori Morimoto mod->irq_dtch = usbhsh_irq_dtch;
1483034d7c13SKuninori Morimoto mod->irq_sack = usbhsh_irq_setup_ack;
1484034d7c13SKuninori Morimoto mod->irq_sign = usbhsh_irq_setup_err;
1485034d7c13SKuninori Morimoto usbhs_irq_callback_update(priv, mod);
1486034d7c13SKuninori Morimoto
1487034d7c13SKuninori Morimoto dev_dbg(dev, "start host\n");
1488034d7c13SKuninori Morimoto
1489034d7c13SKuninori Morimoto return ret;
1490034d7c13SKuninori Morimoto }
1491034d7c13SKuninori Morimoto
usbhsh_stop(struct usbhs_priv * priv)1492034d7c13SKuninori Morimoto static int usbhsh_stop(struct usbhs_priv *priv)
1493034d7c13SKuninori Morimoto {
1494034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1495034d7c13SKuninori Morimoto struct usb_hcd *hcd = usbhsh_hpriv_to_hcd(hpriv);
1496146ee50aSKuninori Morimoto struct usbhs_mod *mod = usbhs_mod_get_current(priv);
1497034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1498034d7c13SKuninori Morimoto
1499146ee50aSKuninori Morimoto /*
1500146ee50aSKuninori Morimoto * disable irq callback
1501146ee50aSKuninori Morimoto */
1502146ee50aSKuninori Morimoto mod->irq_attch = NULL;
1503146ee50aSKuninori Morimoto mod->irq_dtch = NULL;
1504146ee50aSKuninori Morimoto mod->irq_sack = NULL;
1505146ee50aSKuninori Morimoto mod->irq_sign = NULL;
1506146ee50aSKuninori Morimoto usbhs_irq_callback_update(priv, mod);
1507146ee50aSKuninori Morimoto
1508034d7c13SKuninori Morimoto usb_remove_hcd(hcd);
1509034d7c13SKuninori Morimoto
1510034d7c13SKuninori Morimoto /* disable sys */
1511034d7c13SKuninori Morimoto usbhs_sys_host_ctrl(priv, 0);
1512034d7c13SKuninori Morimoto
1513034d7c13SKuninori Morimoto dev_dbg(dev, "quit host\n");
1514034d7c13SKuninori Morimoto
1515034d7c13SKuninori Morimoto return 0;
1516034d7c13SKuninori Morimoto }
1517034d7c13SKuninori Morimoto
usbhs_mod_host_probe(struct usbhs_priv * priv)1518b7a8d17dSKuninori Morimoto int usbhs_mod_host_probe(struct usbhs_priv *priv)
1519034d7c13SKuninori Morimoto {
1520034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv;
1521034d7c13SKuninori Morimoto struct usb_hcd *hcd;
1522034d7c13SKuninori Morimoto struct usbhsh_device *udev;
1523034d7c13SKuninori Morimoto struct device *dev = usbhs_priv_to_dev(priv);
1524034d7c13SKuninori Morimoto int i;
1525034d7c13SKuninori Morimoto
1526034d7c13SKuninori Morimoto /* initialize hcd */
1527034d7c13SKuninori Morimoto hcd = usb_create_hcd(&usbhsh_driver, dev, usbhsh_hcd_name);
1528034d7c13SKuninori Morimoto if (!hcd) {
1529034d7c13SKuninori Morimoto dev_err(dev, "Failed to create hcd\n");
1530034d7c13SKuninori Morimoto return -ENOMEM;
1531034d7c13SKuninori Morimoto }
15321115b9e2SKuninori Morimoto hcd->has_tt = 1; /* for low/full speed */
1533034d7c13SKuninori Morimoto
1534034d7c13SKuninori Morimoto /*
1535034d7c13SKuninori Morimoto * CAUTION
1536034d7c13SKuninori Morimoto *
1537034d7c13SKuninori Morimoto * There is no guarantee that it is possible to access usb module here.
1538034d7c13SKuninori Morimoto * Don't accesses to it.
1539034d7c13SKuninori Morimoto * The accesse will be enable after "usbhsh_start"
1540034d7c13SKuninori Morimoto */
1541034d7c13SKuninori Morimoto
1542034d7c13SKuninori Morimoto hpriv = usbhsh_hcd_to_hpriv(hcd);
1543034d7c13SKuninori Morimoto
1544034d7c13SKuninori Morimoto /*
1545034d7c13SKuninori Morimoto * register itself
1546034d7c13SKuninori Morimoto */
1547034d7c13SKuninori Morimoto usbhs_mod_register(priv, &hpriv->mod, USBHS_HOST);
1548034d7c13SKuninori Morimoto
1549034d7c13SKuninori Morimoto /* init hpriv */
1550034d7c13SKuninori Morimoto hpriv->mod.name = "host";
1551034d7c13SKuninori Morimoto hpriv->mod.start = usbhsh_start;
1552034d7c13SKuninori Morimoto hpriv->mod.stop = usbhsh_stop;
1553034d7c13SKuninori Morimoto usbhsh_port_stat_init(hpriv);
1554034d7c13SKuninori Morimoto
1555034d7c13SKuninori Morimoto /* init all device */
1556034d7c13SKuninori Morimoto usbhsh_for_each_udev_with_dev0(udev, hpriv, i) {
1557034d7c13SKuninori Morimoto udev->usbv = NULL;
1558034d7c13SKuninori Morimoto INIT_LIST_HEAD(&udev->ep_list_head);
1559034d7c13SKuninori Morimoto }
1560034d7c13SKuninori Morimoto
1561034d7c13SKuninori Morimoto dev_info(dev, "host probed\n");
1562034d7c13SKuninori Morimoto
1563034d7c13SKuninori Morimoto return 0;
1564034d7c13SKuninori Morimoto }
1565034d7c13SKuninori Morimoto
usbhs_mod_host_remove(struct usbhs_priv * priv)1566b7a8d17dSKuninori Morimoto int usbhs_mod_host_remove(struct usbhs_priv *priv)
1567034d7c13SKuninori Morimoto {
1568034d7c13SKuninori Morimoto struct usbhsh_hpriv *hpriv = usbhsh_priv_to_hpriv(priv);
1569034d7c13SKuninori Morimoto struct usb_hcd *hcd = usbhsh_hpriv_to_hcd(hpriv);
1570034d7c13SKuninori Morimoto
1571034d7c13SKuninori Morimoto usb_put_hcd(hcd);
1572034d7c13SKuninori Morimoto
1573034d7c13SKuninori Morimoto return 0;
1574034d7c13SKuninori Morimoto }
1575