motg.c revision 1.12.2.8 1 1.12.2.8 skrll /* $NetBSD: motg.c,v 1.12.2.8 2014/12/03 23:05:06 skrll Exp $ */
2 1.1 bouyer
3 1.1 bouyer /*
4 1.1 bouyer * Copyright (c) 1998, 2004, 2011, 2012, 2014 The NetBSD Foundation, Inc.
5 1.1 bouyer * All rights reserved.
6 1.1 bouyer *
7 1.1 bouyer * This code is derived from software contributed to The NetBSD Foundation
8 1.1 bouyer * by Lennart Augustsson (lennart (at) augustsson.net) at
9 1.1 bouyer * Carlstedt Research & Technology, Jared D. McNeill (jmcneill (at) invisible.ca),
10 1.1 bouyer * Matthew R. Green (mrg (at) eterna.com.au), and Manuel Bouyer (bouyer (at) netbsd.org).
11 1.1 bouyer *
12 1.1 bouyer * Redistribution and use in source and binary forms, with or without
13 1.1 bouyer * modification, are permitted provided that the following conditions
14 1.1 bouyer * are met:
15 1.1 bouyer * 1. Redistributions of source code must retain the above copyright
16 1.1 bouyer * notice, this list of conditions and the following disclaimer.
17 1.1 bouyer * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 bouyer * notice, this list of conditions and the following disclaimer in the
19 1.1 bouyer * documentation and/or other materials provided with the distribution.
20 1.1 bouyer *
21 1.1 bouyer * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
22 1.1 bouyer * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.1 bouyer * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.1 bouyer * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
25 1.1 bouyer * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 1.1 bouyer * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 1.1 bouyer * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 1.1 bouyer * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.1 bouyer * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.1 bouyer * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.1 bouyer * POSSIBILITY OF SUCH DAMAGE.
32 1.1 bouyer */
33 1.1 bouyer
34 1.1 bouyer
35 1.1 bouyer /*
36 1.1 bouyer * This file contains the driver for the Mentor Graphics Inventra USB
37 1.1 bouyer * 2.0 High Speed Dual-Role controller.
38 1.1 bouyer *
39 1.1 bouyer * NOTE: The current implementation only supports Device Side Mode!
40 1.1 bouyer */
41 1.1 bouyer
42 1.10 jmcneill #include "opt_motg.h"
43 1.10 jmcneill
44 1.1 bouyer #include <sys/cdefs.h>
45 1.12.2.8 skrll __KERNEL_RCSID(0, "$NetBSD: motg.c,v 1.12.2.8 2014/12/03 23:05:06 skrll Exp $");
46 1.1 bouyer
47 1.1 bouyer #include <sys/param.h>
48 1.1 bouyer #include <sys/systm.h>
49 1.1 bouyer #include <sys/kernel.h>
50 1.1 bouyer #include <sys/kmem.h>
51 1.1 bouyer #include <sys/device.h>
52 1.1 bouyer #include <sys/select.h>
53 1.1 bouyer #include <sys/extent.h>
54 1.1 bouyer #include <sys/proc.h>
55 1.1 bouyer #include <sys/queue.h>
56 1.1 bouyer #include <sys/bus.h>
57 1.1 bouyer #include <sys/cpu.h>
58 1.1 bouyer
59 1.1 bouyer #include <machine/endian.h>
60 1.1 bouyer
61 1.1 bouyer #include <dev/usb/usb.h>
62 1.1 bouyer #include <dev/usb/usbdi.h>
63 1.1 bouyer #include <dev/usb/usbdivar.h>
64 1.1 bouyer #include <dev/usb/usb_mem.h>
65 1.1 bouyer #include <dev/usb/usb_quirks.h>
66 1.1 bouyer
67 1.10 jmcneill #ifdef MOTG_ALLWINNER
68 1.10 jmcneill #include <arch/arm/allwinner/awin_otgreg.h>
69 1.10 jmcneill #else
70 1.1 bouyer #include <dev/usb/motgreg.h>
71 1.10 jmcneill #endif
72 1.10 jmcneill
73 1.1 bouyer #include <dev/usb/motgvar.h>
74 1.12.2.8 skrll #include <dev/usb/usbroothub.h>
75 1.1 bouyer
76 1.1 bouyer #define MOTG_DEBUG
77 1.1 bouyer #ifdef MOTG_DEBUG
78 1.1 bouyer #define DPRINTF(x) if (motgdebug) printf x
79 1.1 bouyer #define DPRINTFN(n,x) if (motgdebug & (n)) printf x
80 1.1 bouyer #define MD_ROOT 0x0002
81 1.1 bouyer #define MD_CTRL 0x0004
82 1.1 bouyer #define MD_BULK 0x0008
83 1.1 bouyer // int motgdebug = MD_ROOT | MD_CTRL | MD_BULK;
84 1.1 bouyer int motgdebug = 0;
85 1.1 bouyer #else
86 1.1 bouyer #define DPRINTF(x)
87 1.1 bouyer #define DPRINTFN(n,x)
88 1.1 bouyer #endif
89 1.1 bouyer
90 1.1 bouyer /* various timeouts, for various speeds */
91 1.1 bouyer /* control NAK timeouts */
92 1.1 bouyer #define NAK_TO_CTRL 10 /* 1024 frames, about 1s */
93 1.1 bouyer #define NAK_TO_CTRL_HIGH 13 /* 8k microframes, about 0.8s */
94 1.1 bouyer
95 1.1 bouyer /* intr/iso polling intervals */
96 1.1 bouyer #define POLL_TO 100 /* 100 frames, about 0.1s */
97 1.1 bouyer #define POLL_TO_HIGH 10 /* 100 microframes, about 0.12s */
98 1.1 bouyer
99 1.1 bouyer /* bulk NAK timeouts */
100 1.3 bouyer #define NAK_TO_BULK 0 /* disabled */
101 1.3 bouyer #define NAK_TO_BULK_HIGH 0
102 1.1 bouyer
103 1.1 bouyer static void motg_hub_change(struct motg_softc *);
104 1.1 bouyer static usbd_status motg_root_ctrl_transfer(usbd_xfer_handle);
105 1.1 bouyer static usbd_status motg_root_ctrl_start(usbd_xfer_handle);
106 1.1 bouyer static void motg_root_ctrl_abort(usbd_xfer_handle);
107 1.1 bouyer static void motg_root_ctrl_close(usbd_pipe_handle);
108 1.1 bouyer static void motg_root_ctrl_done(usbd_xfer_handle);
109 1.1 bouyer
110 1.1 bouyer static usbd_status motg_root_intr_transfer(usbd_xfer_handle);
111 1.1 bouyer static usbd_status motg_root_intr_start(usbd_xfer_handle);
112 1.1 bouyer static void motg_root_intr_abort(usbd_xfer_handle);
113 1.1 bouyer static void motg_root_intr_close(usbd_pipe_handle);
114 1.1 bouyer static void motg_root_intr_done(usbd_xfer_handle);
115 1.1 bouyer
116 1.1 bouyer static usbd_status motg_open(usbd_pipe_handle);
117 1.1 bouyer static void motg_poll(struct usbd_bus *);
118 1.1 bouyer static void motg_softintr(void *);
119 1.1 bouyer static usbd_xfer_handle motg_allocx(struct usbd_bus *);
120 1.1 bouyer static void motg_freex(struct usbd_bus *, usbd_xfer_handle);
121 1.1 bouyer static void motg_get_lock(struct usbd_bus *, kmutex_t **);
122 1.1 bouyer static void motg_noop(usbd_pipe_handle pipe);
123 1.1 bouyer static usbd_status motg_portreset(struct motg_softc*);
124 1.1 bouyer
125 1.1 bouyer static usbd_status motg_device_ctrl_transfer(usbd_xfer_handle);
126 1.1 bouyer static usbd_status motg_device_ctrl_start(usbd_xfer_handle);
127 1.1 bouyer static void motg_device_ctrl_abort(usbd_xfer_handle);
128 1.1 bouyer static void motg_device_ctrl_close(usbd_pipe_handle);
129 1.1 bouyer static void motg_device_ctrl_done(usbd_xfer_handle);
130 1.1 bouyer static usbd_status motg_device_ctrl_start1(struct motg_softc *);
131 1.1 bouyer static void motg_device_ctrl_read(usbd_xfer_handle);
132 1.1 bouyer static void motg_device_ctrl_intr_rx(struct motg_softc *);
133 1.1 bouyer static void motg_device_ctrl_intr_tx(struct motg_softc *);
134 1.1 bouyer
135 1.1 bouyer static usbd_status motg_device_data_transfer(usbd_xfer_handle);
136 1.1 bouyer static usbd_status motg_device_data_start(usbd_xfer_handle);
137 1.1 bouyer static usbd_status motg_device_data_start1(struct motg_softc *,
138 1.1 bouyer struct motg_hw_ep *);
139 1.1 bouyer static void motg_device_data_abort(usbd_xfer_handle);
140 1.1 bouyer static void motg_device_data_close(usbd_pipe_handle);
141 1.1 bouyer static void motg_device_data_done(usbd_xfer_handle);
142 1.1 bouyer static void motg_device_intr_rx(struct motg_softc *, int);
143 1.1 bouyer static void motg_device_intr_tx(struct motg_softc *, int);
144 1.1 bouyer static void motg_device_data_read(usbd_xfer_handle);
145 1.1 bouyer static void motg_device_data_write(usbd_xfer_handle);
146 1.1 bouyer
147 1.1 bouyer static void motg_waitintr(struct motg_softc *, usbd_xfer_handle);
148 1.3 bouyer static void motg_device_clear_toggle(usbd_pipe_handle);
149 1.3 bouyer static void motg_device_xfer_abort(usbd_xfer_handle);
150 1.1 bouyer
151 1.1 bouyer #define MOTG_INTR_ENDPT 1
152 1.1 bouyer #define UBARR(sc) bus_space_barrier((sc)->sc_iot, (sc)->sc_ioh, 0, (sc)->sc_size, \
153 1.1 bouyer BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE)
154 1.1 bouyer #define UWRITE1(sc, r, x) \
155 1.1 bouyer do { UBARR(sc); bus_space_write_1((sc)->sc_iot, (sc)->sc_ioh, (r), (x)); \
156 1.1 bouyer } while (/*CONSTCOND*/0)
157 1.1 bouyer #define UWRITE2(sc, r, x) \
158 1.1 bouyer do { UBARR(sc); bus_space_write_2((sc)->sc_iot, (sc)->sc_ioh, (r), (x)); \
159 1.1 bouyer } while (/*CONSTCOND*/0)
160 1.1 bouyer #define UWRITE4(sc, r, x) \
161 1.1 bouyer do { UBARR(sc); bus_space_write_4((sc)->sc_iot, (sc)->sc_ioh, (r), (x)); \
162 1.1 bouyer } while (/*CONSTCOND*/0)
163 1.1 bouyer
164 1.1 bouyer static __inline uint32_t
165 1.1 bouyer UREAD1(struct motg_softc *sc, bus_size_t r)
166 1.1 bouyer {
167 1.1 bouyer
168 1.1 bouyer UBARR(sc);
169 1.1 bouyer return bus_space_read_1(sc->sc_iot, sc->sc_ioh, r);
170 1.1 bouyer }
171 1.1 bouyer static __inline uint32_t
172 1.1 bouyer UREAD2(struct motg_softc *sc, bus_size_t r)
173 1.1 bouyer {
174 1.1 bouyer
175 1.1 bouyer UBARR(sc);
176 1.1 bouyer return bus_space_read_2(sc->sc_iot, sc->sc_ioh, r);
177 1.1 bouyer }
178 1.4 joerg
179 1.4 joerg #if 0
180 1.1 bouyer static __inline uint32_t
181 1.1 bouyer UREAD4(struct motg_softc *sc, bus_size_t r)
182 1.1 bouyer {
183 1.1 bouyer
184 1.1 bouyer UBARR(sc);
185 1.1 bouyer return bus_space_read_4(sc->sc_iot, sc->sc_ioh, r);
186 1.1 bouyer }
187 1.4 joerg #endif
188 1.1 bouyer
189 1.1 bouyer static void
190 1.7 skrll musbotg_pull_common(struct motg_softc *sc, uint8_t on)
191 1.1 bouyer {
192 1.12.2.2 skrll uint8_t val;
193 1.1 bouyer
194 1.12.2.2 skrll val = UREAD1(sc, MUSB2_REG_POWER);
195 1.12.2.2 skrll if (on)
196 1.12.2.2 skrll val |= MUSB2_MASK_SOFTC;
197 1.12.2.2 skrll else
198 1.12.2.2 skrll val &= ~MUSB2_MASK_SOFTC;
199 1.1 bouyer
200 1.12.2.2 skrll UWRITE1(sc, MUSB2_REG_POWER, val);
201 1.1 bouyer }
202 1.1 bouyer
203 1.1 bouyer const struct usbd_bus_methods motg_bus_methods = {
204 1.12.2.4 skrll .ubm_open = motg_open,
205 1.12.2.4 skrll .ubm_softint = motg_softintr,
206 1.12.2.4 skrll .ubm_dopoll = motg_poll,
207 1.12.2.4 skrll .ubm_allocx = motg_allocx,
208 1.12.2.4 skrll .ubm_freex = motg_freex,
209 1.12.2.4 skrll .ubm_getlock = motg_get_lock,
210 1.12.2.4 skrll .ubm_newdev = NULL,
211 1.1 bouyer };
212 1.1 bouyer
213 1.1 bouyer const struct usbd_pipe_methods motg_root_ctrl_methods = {
214 1.12.2.4 skrll .upm_transfer = motg_root_ctrl_transfer,
215 1.12.2.4 skrll .upm_start = motg_root_ctrl_start,
216 1.12.2.4 skrll .upm_abort = motg_root_ctrl_abort,
217 1.12.2.4 skrll .upm_close = motg_root_ctrl_close,
218 1.12.2.4 skrll .upm_cleartoggle = motg_noop,
219 1.12.2.4 skrll .upm_done = motg_root_ctrl_done,
220 1.1 bouyer };
221 1.1 bouyer
222 1.1 bouyer const struct usbd_pipe_methods motg_root_intr_methods = {
223 1.12.2.4 skrll .upm_transfer = motg_root_intr_transfer,
224 1.12.2.4 skrll .upm_start = motg_root_intr_start,
225 1.12.2.4 skrll .upm_abort = motg_root_intr_abort,
226 1.12.2.4 skrll .upm_close = motg_root_intr_close,
227 1.12.2.4 skrll .upm_cleartoggle = motg_noop,
228 1.12.2.4 skrll .upm_done = motg_root_intr_done,
229 1.1 bouyer };
230 1.1 bouyer
231 1.1 bouyer const struct usbd_pipe_methods motg_device_ctrl_methods = {
232 1.12.2.4 skrll .upm_transfer = motg_device_ctrl_transfer,
233 1.12.2.4 skrll .upm_start = motg_device_ctrl_start,
234 1.12.2.4 skrll .upm_abort = motg_device_ctrl_abort,
235 1.12.2.4 skrll .upm_close = motg_device_ctrl_close,
236 1.12.2.4 skrll .upm_cleartoggle = motg_noop,
237 1.12.2.4 skrll .upm_done = motg_device_ctrl_done,
238 1.1 bouyer };
239 1.1 bouyer
240 1.1 bouyer const struct usbd_pipe_methods motg_device_data_methods = {
241 1.12.2.4 skrll .upm_transfer = motg_device_data_transfer,
242 1.12.2.4 skrll .upm_start = motg_device_data_start,
243 1.12.2.4 skrll .upm_abort = motg_device_data_abort,
244 1.12.2.4 skrll .upm_close = motg_device_data_close,
245 1.12.2.4 skrll .upm_cleartoggle = motg_device_clear_toggle,
246 1.12.2.4 skrll .upm_done = motg_device_data_done,
247 1.1 bouyer };
248 1.1 bouyer
249 1.1 bouyer usbd_status
250 1.1 bouyer motg_init(struct motg_softc *sc)
251 1.1 bouyer {
252 1.1 bouyer uint32_t nrx, ntx, val;
253 1.1 bouyer int dynfifo;
254 1.1 bouyer int offset, i;
255 1.1 bouyer
256 1.1 bouyer if (sc->sc_mode == MOTG_MODE_DEVICE)
257 1.1 bouyer return USBD_NORMAL_COMPLETION; /* not supported */
258 1.1 bouyer
259 1.1 bouyer /* disable all interrupts */
260 1.1 bouyer UWRITE1(sc, MUSB2_REG_INTUSBE, 0);
261 1.1 bouyer UWRITE2(sc, MUSB2_REG_INTTXE, 0);
262 1.1 bouyer UWRITE2(sc, MUSB2_REG_INTRXE, 0);
263 1.1 bouyer /* disable pullup */
264 1.1 bouyer
265 1.7 skrll musbotg_pull_common(sc, 0);
266 1.1 bouyer
267 1.10 jmcneill #ifdef MUSB2_REG_RXDBDIS
268 1.1 bouyer /* disable double packet buffering XXX what's this ? */
269 1.1 bouyer UWRITE2(sc, MUSB2_REG_RXDBDIS, 0xFFFF);
270 1.1 bouyer UWRITE2(sc, MUSB2_REG_TXDBDIS, 0xFFFF);
271 1.10 jmcneill #endif
272 1.1 bouyer
273 1.1 bouyer /* enable HighSpeed and ISO Update flags */
274 1.1 bouyer
275 1.1 bouyer UWRITE1(sc, MUSB2_REG_POWER,
276 1.1 bouyer MUSB2_MASK_HSENAB | MUSB2_MASK_ISOUPD);
277 1.1 bouyer
278 1.1 bouyer if (sc->sc_mode == MOTG_MODE_DEVICE) {
279 1.1 bouyer /* clear Session bit, if set */
280 1.1 bouyer val = UREAD1(sc, MUSB2_REG_DEVCTL);
281 1.1 bouyer val &= ~MUSB2_MASK_SESS;
282 1.1 bouyer UWRITE1(sc, MUSB2_REG_DEVCTL, val);
283 1.1 bouyer } else {
284 1.1 bouyer /* Enter session for Host mode */
285 1.1 bouyer val = UREAD1(sc, MUSB2_REG_DEVCTL);
286 1.1 bouyer val |= MUSB2_MASK_SESS;
287 1.1 bouyer UWRITE1(sc, MUSB2_REG_DEVCTL, val);
288 1.1 bouyer }
289 1.1 bouyer delay(1000);
290 1.1 bouyer DPRINTF(("DEVCTL 0x%x\n", UREAD1(sc, MUSB2_REG_DEVCTL)));
291 1.1 bouyer
292 1.1 bouyer /* disable testmode */
293 1.1 bouyer
294 1.1 bouyer UWRITE1(sc, MUSB2_REG_TESTMODE, 0);
295 1.1 bouyer
296 1.10 jmcneill #ifdef MUSB2_REG_MISC
297 1.7 skrll /* set default value */
298 1.1 bouyer
299 1.1 bouyer UWRITE1(sc, MUSB2_REG_MISC, 0);
300 1.10 jmcneill #endif
301 1.1 bouyer
302 1.7 skrll /* select endpoint index 0 */
303 1.1 bouyer
304 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, 0);
305 1.1 bouyer
306 1.9 jmcneill if (sc->sc_ep_max == 0) {
307 1.9 jmcneill /* read out number of endpoints */
308 1.9 jmcneill nrx = (UREAD1(sc, MUSB2_REG_EPINFO) / 16);
309 1.1 bouyer
310 1.9 jmcneill ntx = (UREAD1(sc, MUSB2_REG_EPINFO) % 16);
311 1.1 bouyer
312 1.9 jmcneill /* these numbers exclude the control endpoint */
313 1.1 bouyer
314 1.9 jmcneill DPRINTF(("RX/TX endpoints: %u/%u\n", nrx, ntx));
315 1.1 bouyer
316 1.9 jmcneill sc->sc_ep_max = MAX(nrx, ntx);
317 1.9 jmcneill } else {
318 1.9 jmcneill nrx = ntx = sc->sc_ep_max;
319 1.9 jmcneill }
320 1.1 bouyer if (sc->sc_ep_max == 0) {
321 1.1 bouyer aprint_error_dev(sc->sc_dev, " no endpoints\n");
322 1.1 bouyer return USBD_INVAL;
323 1.1 bouyer }
324 1.1 bouyer KASSERT(sc->sc_ep_max <= MOTG_MAX_HW_EP);
325 1.1 bouyer /* read out configuration data */
326 1.1 bouyer val = UREAD1(sc, MUSB2_REG_CONFDATA);
327 1.1 bouyer
328 1.1 bouyer DPRINTF(("Config Data: 0x%02x\n", val));
329 1.1 bouyer
330 1.1 bouyer dynfifo = (val & MUSB2_MASK_CD_DYNFIFOSZ) ? 1 : 0;
331 1.1 bouyer
332 1.7 skrll if (dynfifo) {
333 1.1 bouyer aprint_normal_dev(sc->sc_dev, "Dynamic FIFO sizing detected, "
334 1.1 bouyer "assuming 16Kbytes of FIFO RAM\n");
335 1.7 skrll }
336 1.7 skrll
337 1.1 bouyer DPRINTF(("HW version: 0x%04x\n", UREAD1(sc, MUSB2_REG_HWVERS)));
338 1.1 bouyer
339 1.1 bouyer /* initialise endpoint profiles */
340 1.1 bouyer sc->sc_in_ep[0].ep_fifo_size = 64;
341 1.1 bouyer sc->sc_out_ep[0].ep_fifo_size = 0; /* not used */
342 1.1 bouyer sc->sc_out_ep[0].ep_number = sc->sc_in_ep[0].ep_number = 0;
343 1.1 bouyer SIMPLEQ_INIT(&sc->sc_in_ep[0].ep_pipes);
344 1.1 bouyer offset = 64;
345 1.1 bouyer
346 1.1 bouyer for (i = 1; i <= sc->sc_ep_max; i++) {
347 1.1 bouyer int fiforx_size, fifotx_size, fifo_size;
348 1.1 bouyer
349 1.7 skrll /* select endpoint */
350 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, i);
351 1.1 bouyer
352 1.11 jmcneill if (sc->sc_ep_fifosize) {
353 1.11 jmcneill fiforx_size = fifotx_size = sc->sc_ep_fifosize;
354 1.11 jmcneill } else {
355 1.11 jmcneill val = UREAD1(sc, MUSB2_REG_FSIZE);
356 1.11 jmcneill fiforx_size = (val & MUSB2_MASK_RX_FSIZE) >> 4;
357 1.11 jmcneill fifotx_size = (val & MUSB2_MASK_TX_FSIZE);
358 1.11 jmcneill }
359 1.1 bouyer
360 1.1 bouyer DPRINTF(("Endpoint %u FIFO size: IN=%u, OUT=%u, DYN=%d\n",
361 1.1 bouyer i, fifotx_size, fiforx_size, dynfifo));
362 1.1 bouyer
363 1.1 bouyer if (dynfifo) {
364 1.12 jmcneill if (sc->sc_ep_fifosize) {
365 1.12 jmcneill fifo_size = ffs(sc->sc_ep_fifosize) - 1;
366 1.1 bouyer } else {
367 1.12 jmcneill if (i < 3) {
368 1.12 jmcneill fifo_size = 12; /* 4K */
369 1.12 jmcneill } else if (i < 10) {
370 1.12 jmcneill fifo_size = 10; /* 1K */
371 1.12 jmcneill } else {
372 1.12 jmcneill fifo_size = 7; /* 128 bytes */
373 1.12 jmcneill }
374 1.7 skrll }
375 1.1 bouyer if (fiforx_size && (i <= nrx)) {
376 1.1 bouyer fiforx_size = fifo_size;
377 1.1 bouyer if (fifo_size > 7) {
378 1.3 bouyer #if 0
379 1.7 skrll UWRITE1(sc, MUSB2_REG_RXFIFOSZ,
380 1.1 bouyer MUSB2_VAL_FIFOSZ(fifo_size) |
381 1.1 bouyer MUSB2_MASK_FIFODB);
382 1.3 bouyer #else
383 1.7 skrll UWRITE1(sc, MUSB2_REG_RXFIFOSZ,
384 1.3 bouyer MUSB2_VAL_FIFOSZ(fifo_size));
385 1.3 bouyer #endif
386 1.1 bouyer } else {
387 1.7 skrll UWRITE1(sc, MUSB2_REG_RXFIFOSZ,
388 1.3 bouyer MUSB2_VAL_FIFOSZ(fifo_size));
389 1.1 bouyer }
390 1.7 skrll UWRITE2(sc, MUSB2_REG_RXFIFOADD,
391 1.1 bouyer offset >> 3);
392 1.1 bouyer offset += (1 << fiforx_size);
393 1.1 bouyer }
394 1.1 bouyer if (fifotx_size && (i <= ntx)) {
395 1.1 bouyer fifotx_size = fifo_size;
396 1.1 bouyer if (fifo_size > 7) {
397 1.3 bouyer #if 0
398 1.7 skrll UWRITE1(sc, MUSB2_REG_TXFIFOSZ,
399 1.7 skrll MUSB2_VAL_FIFOSZ(fifo_size) |
400 1.1 bouyer MUSB2_MASK_FIFODB);
401 1.3 bouyer #else
402 1.7 skrll UWRITE1(sc, MUSB2_REG_TXFIFOSZ,
403 1.7 skrll MUSB2_VAL_FIFOSZ(fifo_size));
404 1.3 bouyer #endif
405 1.1 bouyer } else {
406 1.7 skrll UWRITE1(sc, MUSB2_REG_TXFIFOSZ,
407 1.7 skrll MUSB2_VAL_FIFOSZ(fifo_size));
408 1.7 skrll }
409 1.7 skrll
410 1.7 skrll UWRITE2(sc, MUSB2_REG_TXFIFOADD,
411 1.1 bouyer offset >> 3);
412 1.7 skrll
413 1.1 bouyer offset += (1 << fifotx_size);
414 1.1 bouyer }
415 1.1 bouyer }
416 1.1 bouyer if (fiforx_size && (i <= nrx)) {
417 1.1 bouyer sc->sc_in_ep[i].ep_fifo_size = (1 << fiforx_size);
418 1.1 bouyer SIMPLEQ_INIT(&sc->sc_in_ep[i].ep_pipes);
419 1.1 bouyer }
420 1.1 bouyer if (fifotx_size && (i <= ntx)) {
421 1.1 bouyer sc->sc_out_ep[i].ep_fifo_size = (1 << fifotx_size);
422 1.1 bouyer SIMPLEQ_INIT(&sc->sc_out_ep[i].ep_pipes);
423 1.1 bouyer }
424 1.1 bouyer sc->sc_out_ep[i].ep_number = sc->sc_in_ep[i].ep_number = i;
425 1.1 bouyer }
426 1.1 bouyer
427 1.7 skrll
428 1.1 bouyer DPRINTF(("Dynamic FIFO size = %d bytes\n", offset));
429 1.1 bouyer
430 1.1 bouyer /* turn on default interrupts */
431 1.1 bouyer
432 1.1 bouyer if (sc->sc_mode == MOTG_MODE_HOST) {
433 1.1 bouyer UWRITE1(sc, MUSB2_REG_INTUSBE, 0xff);
434 1.1 bouyer UWRITE2(sc, MUSB2_REG_INTTXE, 0xffff);
435 1.1 bouyer UWRITE2(sc, MUSB2_REG_INTRXE, 0xffff);
436 1.1 bouyer } else
437 1.1 bouyer UWRITE1(sc, MUSB2_REG_INTUSBE, MUSB2_MASK_IRESET);
438 1.1 bouyer
439 1.1 bouyer sc->sc_xferpool = pool_cache_init(sizeof(struct motg_xfer), 0, 0, 0,
440 1.1 bouyer "motgxfer", NULL, IPL_USB, NULL, NULL, NULL);
441 1.1 bouyer
442 1.1 bouyer mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
443 1.1 bouyer mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED);
444 1.1 bouyer
445 1.1 bouyer /* Set up the bus struct. */
446 1.12.2.6 skrll sc->sc_bus.ub_methods = &motg_bus_methods;
447 1.12.2.6 skrll sc->sc_bus.ub_pipesize= sizeof(struct motg_pipe);
448 1.12.2.6 skrll sc->sc_bus.ub_revision = USBREV_2_0;
449 1.12.2.6 skrll sc->sc_bus.ub_hcpriv = sc;
450 1.1 bouyer snprintf(sc->sc_vendor, sizeof(sc->sc_vendor),
451 1.1 bouyer "Mentor Graphics");
452 1.1 bouyer sc->sc_child = config_found(sc->sc_dev, &sc->sc_bus, usbctlprint);
453 1.1 bouyer return USBD_NORMAL_COMPLETION;
454 1.1 bouyer }
455 1.1 bouyer
456 1.1 bouyer static int
457 1.1 bouyer motg_select_ep(struct motg_softc *sc, usbd_pipe_handle pipe)
458 1.1 bouyer {
459 1.1 bouyer struct motg_pipe *otgpipe = (struct motg_pipe *)pipe;
460 1.12.2.6 skrll usb_endpoint_descriptor_t *ed = pipe->up_endpoint->ue_edesc;
461 1.1 bouyer struct motg_hw_ep *ep;
462 1.1 bouyer int i, size;
463 1.1 bouyer
464 1.1 bouyer ep = (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) ?
465 1.1 bouyer sc->sc_in_ep : sc->sc_out_ep;
466 1.12.2.6 skrll size = UE_GET_SIZE(UGETW(pipe->up_endpoint->ue_edesc->wMaxPacketSize));
467 1.1 bouyer
468 1.1 bouyer for (i = sc->sc_ep_max; i >= 1; i--) {
469 1.1 bouyer DPRINTF(("%s_ep[%d].ep_fifo_size %d size %d ref %d\n",
470 1.1 bouyer (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) ?
471 1.1 bouyer "in" : "out", i, ep[i].ep_fifo_size, size, ep[i].refcount));
472 1.1 bouyer if (ep[i].ep_fifo_size >= size) {
473 1.1 bouyer /* found a suitable endpoint */
474 1.1 bouyer otgpipe->hw_ep = &ep[i];
475 1.1 bouyer mutex_enter(&sc->sc_lock);
476 1.1 bouyer if (otgpipe->hw_ep->refcount > 0) {
477 1.1 bouyer /* no luck, try next */
478 1.1 bouyer mutex_exit(&sc->sc_lock);
479 1.1 bouyer otgpipe->hw_ep = NULL;
480 1.1 bouyer } else {
481 1.1 bouyer otgpipe->hw_ep->refcount++;
482 1.1 bouyer SIMPLEQ_INSERT_TAIL(&otgpipe->hw_ep->ep_pipes,
483 1.1 bouyer otgpipe, ep_pipe_list);
484 1.1 bouyer mutex_exit(&sc->sc_lock);
485 1.1 bouyer return 0;
486 1.1 bouyer }
487 1.1 bouyer }
488 1.1 bouyer }
489 1.1 bouyer return -1;
490 1.1 bouyer }
491 1.1 bouyer
492 1.1 bouyer /* Open a new pipe. */
493 1.1 bouyer usbd_status
494 1.1 bouyer motg_open(usbd_pipe_handle pipe)
495 1.1 bouyer {
496 1.12.2.6 skrll struct motg_softc *sc = pipe->up_dev->ud_bus->ub_hcpriv;
497 1.1 bouyer struct motg_pipe *otgpipe = (struct motg_pipe *)pipe;
498 1.12.2.6 skrll usb_endpoint_descriptor_t *ed = pipe->up_endpoint->ue_edesc;
499 1.1 bouyer
500 1.1 bouyer DPRINTF(("motg_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
501 1.12.2.6 skrll pipe, pipe->up_dev->ud_addr,
502 1.1 bouyer ed->bEndpointAddress, sc->sc_root_addr));
503 1.1 bouyer
504 1.1 bouyer if (sc->sc_dying)
505 1.1 bouyer return USBD_IOERROR;
506 1.1 bouyer
507 1.1 bouyer /* toggle state needed for bulk endpoints */
508 1.12.2.6 skrll otgpipe->nexttoggle = pipe->up_endpoint->ue_toggle;
509 1.1 bouyer
510 1.12.2.6 skrll if (pipe->up_dev->ud_addr == sc->sc_root_addr) {
511 1.1 bouyer switch (ed->bEndpointAddress) {
512 1.1 bouyer case USB_CONTROL_ENDPOINT:
513 1.12.2.6 skrll pipe->up_methods = &motg_root_ctrl_methods;
514 1.1 bouyer break;
515 1.1 bouyer case UE_DIR_IN | MOTG_INTR_ENDPT:
516 1.12.2.6 skrll pipe->up_methods = &motg_root_intr_methods;
517 1.1 bouyer break;
518 1.1 bouyer default:
519 1.1 bouyer return (USBD_INVAL);
520 1.1 bouyer }
521 1.1 bouyer } else {
522 1.1 bouyer switch (ed->bmAttributes & UE_XFERTYPE) {
523 1.1 bouyer case UE_CONTROL:
524 1.12.2.6 skrll pipe->up_methods = &motg_device_ctrl_methods;
525 1.1 bouyer /* always use sc_in_ep[0] for in and out */
526 1.1 bouyer otgpipe->hw_ep = &sc->sc_in_ep[0];
527 1.1 bouyer mutex_enter(&sc->sc_lock);
528 1.1 bouyer otgpipe->hw_ep->refcount++;
529 1.1 bouyer SIMPLEQ_INSERT_TAIL(&otgpipe->hw_ep->ep_pipes,
530 1.1 bouyer otgpipe, ep_pipe_list);
531 1.1 bouyer mutex_exit(&sc->sc_lock);
532 1.1 bouyer break;
533 1.1 bouyer case UE_BULK:
534 1.1 bouyer case UE_INTERRUPT:
535 1.7 skrll DPRINTFN(MD_BULK,
536 1.1 bouyer ("new %s %s pipe wMaxPacketSize %d\n",
537 1.1 bouyer (ed->bmAttributes & UE_XFERTYPE) == UE_BULK ?
538 1.1 bouyer "bulk" : "interrupt",
539 1.12.2.6 skrll (UE_GET_DIR(pipe->up_endpoint->ue_edesc->bEndpointAddress) == UE_DIR_IN) ? "read" : "write",
540 1.12.2.6 skrll UGETW(pipe->up_endpoint->ue_edesc->wMaxPacketSize)));
541 1.1 bouyer if (motg_select_ep(sc, pipe) != 0)
542 1.1 bouyer goto bad;
543 1.1 bouyer KASSERT(otgpipe->hw_ep != NULL);
544 1.12.2.6 skrll pipe->up_methods = &motg_device_data_methods;
545 1.12.2.6 skrll otgpipe->nexttoggle = pipe->up_endpoint->ue_toggle;
546 1.1 bouyer break;
547 1.1 bouyer default:
548 1.1 bouyer goto bad;
549 1.1 bouyer #ifdef notyet
550 1.1 bouyer case UE_ISOCHRONOUS:
551 1.1 bouyer ...
552 1.1 bouyer break;
553 1.1 bouyer #endif /* notyet */
554 1.1 bouyer }
555 1.1 bouyer }
556 1.1 bouyer return (USBD_NORMAL_COMPLETION);
557 1.1 bouyer
558 1.1 bouyer bad:
559 1.1 bouyer return (USBD_NOMEM);
560 1.1 bouyer }
561 1.1 bouyer
562 1.1 bouyer void
563 1.1 bouyer motg_softintr(void *v)
564 1.1 bouyer {
565 1.1 bouyer struct usbd_bus *bus = v;
566 1.12.2.6 skrll struct motg_softc *sc = bus->ub_hcpriv;
567 1.1 bouyer uint16_t rx_status, tx_status;
568 1.1 bouyer uint8_t ctrl_status;
569 1.1 bouyer uint32_t val;
570 1.1 bouyer int i;
571 1.1 bouyer
572 1.12.2.6 skrll KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
573 1.1 bouyer
574 1.1 bouyer DPRINTFN(MD_ROOT | MD_CTRL,
575 1.1 bouyer ("%s: motg_softintr\n", device_xname(sc->sc_dev)));
576 1.1 bouyer
577 1.1 bouyer mutex_spin_enter(&sc->sc_intr_lock);
578 1.1 bouyer rx_status = sc->sc_intr_rx_ep;
579 1.1 bouyer sc->sc_intr_rx_ep = 0;
580 1.1 bouyer tx_status = sc->sc_intr_tx_ep;
581 1.1 bouyer sc->sc_intr_tx_ep = 0;
582 1.1 bouyer ctrl_status = sc->sc_intr_ctrl;
583 1.1 bouyer sc->sc_intr_ctrl = 0;
584 1.1 bouyer mutex_spin_exit(&sc->sc_intr_lock);
585 1.1 bouyer
586 1.1 bouyer ctrl_status |= UREAD1(sc, MUSB2_REG_INTUSB);
587 1.1 bouyer
588 1.1 bouyer if (ctrl_status & (MUSB2_MASK_IRESET |
589 1.1 bouyer MUSB2_MASK_IRESUME | MUSB2_MASK_ISUSP |
590 1.1 bouyer MUSB2_MASK_ICONN | MUSB2_MASK_IDISC)) {
591 1.1 bouyer DPRINTFN(MD_ROOT | MD_CTRL, ("motg_softintr bus 0x%x\n",
592 1.1 bouyer ctrl_status));
593 1.1 bouyer
594 1.1 bouyer if (ctrl_status & MUSB2_MASK_IRESET) {
595 1.1 bouyer sc->sc_isreset = 1;
596 1.1 bouyer sc->sc_port_suspended = 0;
597 1.1 bouyer sc->sc_port_suspended_change = 1;
598 1.1 bouyer sc->sc_connected_changed = 1;
599 1.1 bouyer sc->sc_port_enabled = 1;
600 1.1 bouyer
601 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
602 1.1 bouyer if (val & MUSB2_MASK_HSMODE)
603 1.1 bouyer sc->sc_high_speed = 1;
604 1.1 bouyer else
605 1.1 bouyer sc->sc_high_speed = 0;
606 1.1 bouyer DPRINTFN(MD_ROOT | MD_CTRL, ("motg_softintr speed %d\n",
607 1.1 bouyer sc->sc_high_speed));
608 1.1 bouyer
609 1.1 bouyer /* turn off interrupts */
610 1.1 bouyer val = MUSB2_MASK_IRESET;
611 1.1 bouyer val &= ~MUSB2_MASK_IRESUME;
612 1.1 bouyer val |= MUSB2_MASK_ISUSP;
613 1.1 bouyer UWRITE1(sc, MUSB2_REG_INTUSBE, val);
614 1.1 bouyer UWRITE2(sc, MUSB2_REG_INTTXE, 0);
615 1.1 bouyer UWRITE2(sc, MUSB2_REG_INTRXE, 0);
616 1.1 bouyer }
617 1.1 bouyer if (ctrl_status & MUSB2_MASK_IRESUME) {
618 1.1 bouyer if (sc->sc_port_suspended) {
619 1.1 bouyer sc->sc_port_suspended = 0;
620 1.1 bouyer sc->sc_port_suspended_change = 1;
621 1.1 bouyer val = UREAD1(sc, MUSB2_REG_INTUSBE);
622 1.1 bouyer /* disable resume interrupt */
623 1.1 bouyer val &= ~MUSB2_MASK_IRESUME;
624 1.1 bouyer /* enable suspend interrupt */
625 1.1 bouyer val |= MUSB2_MASK_ISUSP;
626 1.1 bouyer UWRITE1(sc, MUSB2_REG_INTUSBE, val);
627 1.1 bouyer }
628 1.1 bouyer } else if (ctrl_status & MUSB2_MASK_ISUSP) {
629 1.1 bouyer if (!sc->sc_port_suspended) {
630 1.1 bouyer sc->sc_port_suspended = 1;
631 1.1 bouyer sc->sc_port_suspended_change = 1;
632 1.1 bouyer
633 1.1 bouyer val = UREAD1(sc, MUSB2_REG_INTUSBE);
634 1.1 bouyer /* disable suspend interrupt */
635 1.1 bouyer val &= ~MUSB2_MASK_ISUSP;
636 1.1 bouyer /* enable resume interrupt */
637 1.1 bouyer val |= MUSB2_MASK_IRESUME;
638 1.1 bouyer UWRITE1(sc, MUSB2_REG_INTUSBE, val);
639 1.1 bouyer }
640 1.1 bouyer }
641 1.1 bouyer if (ctrl_status & MUSB2_MASK_ICONN) {
642 1.1 bouyer sc->sc_connected = 1;
643 1.1 bouyer sc->sc_connected_changed = 1;
644 1.1 bouyer sc->sc_isreset = 1;
645 1.1 bouyer sc->sc_port_enabled = 1;
646 1.1 bouyer } else if (ctrl_status & MUSB2_MASK_IDISC) {
647 1.1 bouyer sc->sc_connected = 0;
648 1.1 bouyer sc->sc_connected_changed = 1;
649 1.1 bouyer sc->sc_isreset = 0;
650 1.1 bouyer sc->sc_port_enabled = 0;
651 1.1 bouyer }
652 1.1 bouyer
653 1.1 bouyer /* complete root HUB interrupt endpoint */
654 1.1 bouyer
655 1.1 bouyer motg_hub_change(sc);
656 1.1 bouyer }
657 1.1 bouyer /*
658 1.1 bouyer * read in interrupt status and mix with the status we
659 1.1 bouyer * got from the wrapper
660 1.1 bouyer */
661 1.1 bouyer rx_status |= UREAD2(sc, MUSB2_REG_INTRX);
662 1.1 bouyer tx_status |= UREAD2(sc, MUSB2_REG_INTTX);
663 1.1 bouyer
664 1.1 bouyer if (rx_status & 0x01)
665 1.10 jmcneill panic("ctrl_rx %08x", rx_status);
666 1.1 bouyer if (tx_status & 0x01)
667 1.1 bouyer motg_device_ctrl_intr_tx(sc);
668 1.1 bouyer for (i = 1; i <= sc->sc_ep_max; i++) {
669 1.1 bouyer if (rx_status & (0x01 << i))
670 1.1 bouyer motg_device_intr_rx(sc, i);
671 1.1 bouyer if (tx_status & (0x01 << i))
672 1.1 bouyer motg_device_intr_tx(sc, i);
673 1.1 bouyer }
674 1.1 bouyer return;
675 1.1 bouyer }
676 1.1 bouyer
677 1.1 bouyer void
678 1.1 bouyer motg_poll(struct usbd_bus *bus)
679 1.1 bouyer {
680 1.12.2.6 skrll struct motg_softc *sc = bus->ub_hcpriv;
681 1.1 bouyer
682 1.1 bouyer sc->sc_intr_poll(sc->sc_intr_poll_arg);
683 1.1 bouyer mutex_enter(&sc->sc_lock);
684 1.1 bouyer motg_softintr(bus);
685 1.1 bouyer mutex_exit(&sc->sc_lock);
686 1.1 bouyer }
687 1.1 bouyer
688 1.1 bouyer int
689 1.1 bouyer motg_intr(struct motg_softc *sc, uint16_t rx_ep, uint16_t tx_ep,
690 1.2 bouyer uint8_t ctrl)
691 1.1 bouyer {
692 1.1 bouyer KASSERT(mutex_owned(&sc->sc_intr_lock));
693 1.1 bouyer sc->sc_intr_tx_ep = tx_ep;
694 1.1 bouyer sc->sc_intr_rx_ep = rx_ep;
695 1.1 bouyer sc->sc_intr_ctrl = ctrl;
696 1.1 bouyer
697 1.12.2.6 skrll if (!sc->sc_bus.ub_usepolling) {
698 1.1 bouyer usb_schedsoftintr(&sc->sc_bus);
699 1.1 bouyer }
700 1.1 bouyer return 1;
701 1.1 bouyer }
702 1.1 bouyer
703 1.2 bouyer int
704 1.2 bouyer motg_intr_vbus(struct motg_softc *sc, int vbus)
705 1.2 bouyer {
706 1.2 bouyer uint8_t val;
707 1.2 bouyer if (sc->sc_mode == MOTG_MODE_HOST && vbus == 0) {
708 1.2 bouyer DPRINTF(("motg_intr_vbus: vbus down, try to re-enable\n"));
709 1.2 bouyer /* try to re-enter session for Host mode */
710 1.2 bouyer val = UREAD1(sc, MUSB2_REG_DEVCTL);
711 1.2 bouyer val |= MUSB2_MASK_SESS;
712 1.2 bouyer UWRITE1(sc, MUSB2_REG_DEVCTL, val);
713 1.2 bouyer }
714 1.2 bouyer return 1;
715 1.2 bouyer }
716 1.2 bouyer
717 1.1 bouyer usbd_xfer_handle
718 1.1 bouyer motg_allocx(struct usbd_bus *bus)
719 1.1 bouyer {
720 1.12.2.6 skrll struct motg_softc *sc = bus->ub_hcpriv;
721 1.1 bouyer usbd_xfer_handle xfer;
722 1.1 bouyer
723 1.1 bouyer xfer = pool_cache_get(sc->sc_xferpool, PR_NOWAIT);
724 1.1 bouyer if (xfer != NULL) {
725 1.1 bouyer memset(xfer, 0, sizeof(struct motg_xfer));
726 1.1 bouyer UXFER(xfer)->sc = sc;
727 1.1 bouyer #ifdef DIAGNOSTIC
728 1.1 bouyer // XXX UXFER(xfer)->iinfo.isdone = 1;
729 1.12.2.6 skrll xfer->ux_state = XFER_BUSY;
730 1.1 bouyer #endif
731 1.1 bouyer }
732 1.1 bouyer return (xfer);
733 1.1 bouyer }
734 1.1 bouyer
735 1.1 bouyer void
736 1.1 bouyer motg_freex(struct usbd_bus *bus, usbd_xfer_handle xfer)
737 1.1 bouyer {
738 1.12.2.6 skrll struct motg_softc *sc = bus->ub_hcpriv;
739 1.1 bouyer
740 1.1 bouyer #ifdef DIAGNOSTIC
741 1.12.2.6 skrll if (xfer->ux_state != XFER_BUSY) {
742 1.1 bouyer printf("motg_freex: xfer=%p not busy, 0x%08x\n", xfer,
743 1.12.2.6 skrll xfer->ux_state);
744 1.1 bouyer }
745 1.12.2.6 skrll xfer->ux_state = XFER_FREE;
746 1.1 bouyer #endif
747 1.1 bouyer pool_cache_put(sc->sc_xferpool, xfer);
748 1.1 bouyer }
749 1.1 bouyer
750 1.1 bouyer static void
751 1.1 bouyer motg_get_lock(struct usbd_bus *bus, kmutex_t **lock)
752 1.1 bouyer {
753 1.12.2.6 skrll struct motg_softc *sc = bus->ub_hcpriv;
754 1.1 bouyer
755 1.1 bouyer *lock = &sc->sc_lock;
756 1.1 bouyer }
757 1.1 bouyer
758 1.1 bouyer /*
759 1.1 bouyer * Data structures and routines to emulate the root hub.
760 1.1 bouyer */
761 1.1 bouyer usb_device_descriptor_t motg_devd = {
762 1.12.2.7 skrll .bLength = USB_DEVICE_DESCRIPTOR_SIZE,
763 1.12.2.7 skrll .bDescriptorType = UDESC_DEVICE,
764 1.12.2.7 skrll .bcdUSB = {0x00, 0x01},
765 1.12.2.7 skrll .bDeviceClass = UDCLASS_HUB,
766 1.12.2.7 skrll .bDeviceSubClass = UDSUBCLASS_HUB,
767 1.12.2.7 skrll .bDeviceProtocol = UDPROTO_FSHUB,
768 1.12.2.7 skrll .bMaxPacketSize = 64,
769 1.12.2.7 skrll .idVendor = {0},
770 1.12.2.7 skrll .idProduct = {0},
771 1.12.2.7 skrll .bcdDevice = {0x00,0x01},
772 1.12.2.7 skrll .iManufacturer = 1,
773 1.12.2.7 skrll .iProduct = 2,
774 1.12.2.7 skrll .iSerialNumber = 0,
775 1.12.2.7 skrll .bNumConfigurations = 1
776 1.1 bouyer };
777 1.1 bouyer
778 1.1 bouyer const usb_config_descriptor_t motg_confd = {
779 1.12.2.7 skrll .bLength = USB_CONFIG_DESCRIPTOR_SIZE,
780 1.12.2.7 skrll .bDescriptorType = UDESC_CONFIG,
781 1.12.2.7 skrll .wTotalLength = USETWD(
782 1.12.2.7 skrll USB_CONFIG_DESCRIPTOR_SIZE +
783 1.12.2.7 skrll USB_INTERFACE_DESCRIPTOR_SIZE +
784 1.12.2.7 skrll USB_ENDPOINT_DESCRIPTOR_SIZE),
785 1.12.2.7 skrll .bNumInterface = 1,
786 1.12.2.7 skrll .bConfigurationValue = 1,
787 1.12.2.7 skrll .iConfiguration = 0,
788 1.12.2.7 skrll .bmAttributes = UC_ATTR_MBO | UC_SELF_POWERED,
789 1.12.2.7 skrll .bMaxPower = 0
790 1.1 bouyer };
791 1.1 bouyer
792 1.1 bouyer const usb_interface_descriptor_t motg_ifcd = {
793 1.12.2.7 skrll .bLength = USB_INTERFACE_DESCRIPTOR_SIZE,
794 1.12.2.7 skrll .bDescriptorType = UDESC_INTERFACE,
795 1.12.2.7 skrll .bInterfaceNumber = 0,
796 1.12.2.7 skrll .bAlternateSetting = 0,
797 1.12.2.7 skrll .bNumEndpoints = 1,
798 1.12.2.7 skrll .bInterfaceClass = UICLASS_HUB,
799 1.12.2.7 skrll .bInterfaceSubClass = UISUBCLASS_HUB,
800 1.12.2.7 skrll .bInterfaceProtocol = UIPROTO_FSHUB,
801 1.1 bouyer };
802 1.1 bouyer
803 1.1 bouyer const usb_endpoint_descriptor_t motg_endpd = {
804 1.12.2.7 skrll .bLength = USB_ENDPOINT_DESCRIPTOR_SIZE,
805 1.12.2.7 skrll .bDescriptorType = UDESC_ENDPOINT,
806 1.12.2.7 skrll .bEndpointAddress = UE_DIR_IN | MOTG_INTR_ENDPT,
807 1.12.2.7 skrll .bmAttributes = UE_INTERRUPT,
808 1.12.2.7 skrll .wMaxPacketSize = USETWD(8),
809 1.12.2.7 skrll .bInterval = 255
810 1.1 bouyer };
811 1.1 bouyer
812 1.1 bouyer const usb_hub_descriptor_t motg_hubd = {
813 1.12.2.7 skrll .bDescLength = USB_HUB_DESCRIPTOR_SIZE,
814 1.12.2.7 skrll .bDescriptorType = UDESC_HUB,
815 1.12.2.7 skrll .bNbrPorts = 1,
816 1.12.2.7 skrll .wHubCharacteristics = USETWD(UHD_PWR_NO_SWITCH | UHD_OC_INDIVIDUAL),
817 1.12.2.7 skrll .bPwrOn2PwrGood = 50,
818 1.12.2.7 skrll .bHubContrCurrent = 0,
819 1.12.2.7 skrll .DeviceRemovable = { 0 },
820 1.12.2.7 skrll .PortPowerCtrlMask = { 0 },
821 1.1 bouyer };
822 1.1 bouyer
823 1.1 bouyer /*
824 1.1 bouyer * Simulate a hardware hub by handling all the necessary requests.
825 1.1 bouyer */
826 1.1 bouyer usbd_status
827 1.1 bouyer motg_root_ctrl_transfer(usbd_xfer_handle xfer)
828 1.1 bouyer {
829 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
830 1.1 bouyer usbd_status err;
831 1.1 bouyer
832 1.1 bouyer /* Insert last in queue. */
833 1.1 bouyer mutex_enter(&sc->sc_lock);
834 1.1 bouyer err = usb_insert_transfer(xfer);
835 1.1 bouyer mutex_exit(&sc->sc_lock);
836 1.1 bouyer if (err)
837 1.1 bouyer return (err);
838 1.1 bouyer
839 1.1 bouyer /*
840 1.1 bouyer * Pipe isn't running (otherwise err would be USBD_INPROG),
841 1.1 bouyer * so start it first.
842 1.1 bouyer */
843 1.12.2.6 skrll return (motg_root_ctrl_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue)));
844 1.1 bouyer }
845 1.1 bouyer
846 1.1 bouyer usbd_status
847 1.1 bouyer motg_root_ctrl_start(usbd_xfer_handle xfer)
848 1.1 bouyer {
849 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
850 1.1 bouyer usb_device_request_t *req;
851 1.1 bouyer void *buf = NULL;
852 1.1 bouyer int len, value, index, status, change, l, totlen = 0;
853 1.1 bouyer usb_port_status_t ps;
854 1.1 bouyer usbd_status err;
855 1.1 bouyer uint32_t val;
856 1.1 bouyer
857 1.1 bouyer if (sc->sc_dying)
858 1.1 bouyer return (USBD_IOERROR);
859 1.1 bouyer
860 1.1 bouyer #ifdef DIAGNOSTIC
861 1.12.2.6 skrll if (!(xfer->ux_rqflags & URQ_REQUEST))
862 1.1 bouyer panic("motg_root_ctrl_start: not a request");
863 1.1 bouyer #endif
864 1.12.2.6 skrll req = &xfer->ux_request;
865 1.1 bouyer
866 1.1 bouyer DPRINTFN(MD_ROOT,("motg_root_ctrl_control type=0x%02x request=%02x\n",
867 1.1 bouyer req->bmRequestType, req->bRequest));
868 1.1 bouyer
869 1.1 bouyer len = UGETW(req->wLength);
870 1.1 bouyer value = UGETW(req->wValue);
871 1.1 bouyer index = UGETW(req->wIndex);
872 1.1 bouyer
873 1.1 bouyer if (len != 0)
874 1.12.2.6 skrll buf = xfer->ux_buf;
875 1.1 bouyer
876 1.1 bouyer #define C(x,y) ((x) | ((y) << 8))
877 1.1 bouyer switch(C(req->bRequest, req->bmRequestType)) {
878 1.1 bouyer case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
879 1.1 bouyer case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
880 1.1 bouyer case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
881 1.1 bouyer /*
882 1.1 bouyer * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
883 1.1 bouyer * for the integrated root hub.
884 1.1 bouyer */
885 1.1 bouyer break;
886 1.1 bouyer case C(UR_GET_CONFIG, UT_READ_DEVICE):
887 1.1 bouyer if (len > 0) {
888 1.12.2.1 skrll *(uint8_t *)buf = sc->sc_root_conf;
889 1.1 bouyer totlen = 1;
890 1.1 bouyer }
891 1.1 bouyer break;
892 1.1 bouyer case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
893 1.1 bouyer DPRINTFN(MD_ROOT,("motg_root_ctrl_control wValue=0x%04x\n", value));
894 1.1 bouyer if (len == 0)
895 1.1 bouyer break;
896 1.1 bouyer switch(value >> 8) {
897 1.1 bouyer case UDESC_DEVICE:
898 1.1 bouyer if ((value & 0xff) != 0) {
899 1.1 bouyer err = USBD_IOERROR;
900 1.1 bouyer goto ret;
901 1.1 bouyer }
902 1.1 bouyer totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
903 1.1 bouyer USETW(motg_devd.idVendor, sc->sc_id_vendor);
904 1.1 bouyer memcpy(buf, &motg_devd, l);
905 1.1 bouyer break;
906 1.1 bouyer case UDESC_CONFIG:
907 1.1 bouyer if ((value & 0xff) != 0) {
908 1.1 bouyer err = USBD_IOERROR;
909 1.1 bouyer goto ret;
910 1.1 bouyer }
911 1.1 bouyer totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
912 1.1 bouyer memcpy(buf, &motg_confd, l);
913 1.1 bouyer buf = (char *)buf + l;
914 1.1 bouyer len -= l;
915 1.1 bouyer l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
916 1.1 bouyer totlen += l;
917 1.1 bouyer memcpy(buf, &motg_ifcd, l);
918 1.1 bouyer buf = (char *)buf + l;
919 1.1 bouyer len -= l;
920 1.1 bouyer l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
921 1.1 bouyer totlen += l;
922 1.1 bouyer memcpy(buf, &motg_endpd, l);
923 1.1 bouyer break;
924 1.1 bouyer case UDESC_STRING:
925 1.1 bouyer #define sd ((usb_string_descriptor_t *)buf)
926 1.1 bouyer switch (value & 0xff) {
927 1.1 bouyer case 0: /* Language table */
928 1.1 bouyer totlen = usb_makelangtbl(sd, len);
929 1.1 bouyer break;
930 1.1 bouyer case 1: /* Vendor */
931 1.1 bouyer totlen = usb_makestrdesc(sd, len,
932 1.1 bouyer sc->sc_vendor);
933 1.1 bouyer break;
934 1.1 bouyer case 2: /* Product */
935 1.1 bouyer totlen = usb_makestrdesc(sd, len,
936 1.1 bouyer "MOTG root hub");
937 1.1 bouyer break;
938 1.1 bouyer }
939 1.1 bouyer #undef sd
940 1.1 bouyer break;
941 1.1 bouyer default:
942 1.1 bouyer err = USBD_IOERROR;
943 1.1 bouyer goto ret;
944 1.1 bouyer }
945 1.1 bouyer break;
946 1.1 bouyer case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
947 1.1 bouyer if (len > 0) {
948 1.12.2.1 skrll *(uint8_t *)buf = 0;
949 1.1 bouyer totlen = 1;
950 1.1 bouyer }
951 1.1 bouyer break;
952 1.1 bouyer case C(UR_GET_STATUS, UT_READ_DEVICE):
953 1.1 bouyer if (len > 1) {
954 1.1 bouyer USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
955 1.1 bouyer totlen = 2;
956 1.1 bouyer }
957 1.1 bouyer break;
958 1.1 bouyer case C(UR_GET_STATUS, UT_READ_INTERFACE):
959 1.1 bouyer case C(UR_GET_STATUS, UT_READ_ENDPOINT):
960 1.1 bouyer if (len > 1) {
961 1.1 bouyer USETW(((usb_status_t *)buf)->wStatus, 0);
962 1.1 bouyer totlen = 2;
963 1.1 bouyer }
964 1.1 bouyer break;
965 1.1 bouyer case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
966 1.1 bouyer if (value >= USB_MAX_DEVICES) {
967 1.1 bouyer err = USBD_IOERROR;
968 1.1 bouyer goto ret;
969 1.1 bouyer }
970 1.1 bouyer sc->sc_root_addr = value;
971 1.1 bouyer break;
972 1.1 bouyer case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
973 1.1 bouyer if (value != 0 && value != 1) {
974 1.1 bouyer err = USBD_IOERROR;
975 1.1 bouyer goto ret;
976 1.1 bouyer }
977 1.1 bouyer sc->sc_root_conf = value;
978 1.1 bouyer break;
979 1.1 bouyer case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
980 1.1 bouyer break;
981 1.1 bouyer case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
982 1.1 bouyer case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
983 1.1 bouyer case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
984 1.1 bouyer err = USBD_IOERROR;
985 1.1 bouyer goto ret;
986 1.1 bouyer case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
987 1.1 bouyer break;
988 1.1 bouyer case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
989 1.1 bouyer break;
990 1.1 bouyer /* Hub requests */
991 1.1 bouyer case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
992 1.1 bouyer break;
993 1.1 bouyer case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
994 1.1 bouyer DPRINTFN(MD_ROOT,
995 1.1 bouyer ("motg_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
996 1.1 bouyer "port=%d feature=%d\n",
997 1.1 bouyer index, value));
998 1.1 bouyer if (index != 1) {
999 1.1 bouyer err = USBD_IOERROR;
1000 1.1 bouyer goto ret;
1001 1.1 bouyer }
1002 1.1 bouyer switch(value) {
1003 1.1 bouyer case UHF_PORT_ENABLE:
1004 1.1 bouyer sc->sc_port_enabled = 0;
1005 1.1 bouyer break;
1006 1.1 bouyer case UHF_PORT_SUSPEND:
1007 1.1 bouyer if (sc->sc_port_suspended != 0) {
1008 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
1009 1.1 bouyer val &= ~MUSB2_MASK_SUSPMODE;
1010 1.1 bouyer val |= MUSB2_MASK_RESUME;
1011 1.1 bouyer UWRITE1(sc, MUSB2_REG_POWER, val);
1012 1.1 bouyer /* wait 20 milliseconds */
1013 1.1 bouyer usb_delay_ms(&sc->sc_bus, 20);
1014 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
1015 1.1 bouyer val &= ~MUSB2_MASK_RESUME;
1016 1.1 bouyer UWRITE1(sc, MUSB2_REG_POWER, val);
1017 1.1 bouyer sc->sc_port_suspended = 0;
1018 1.1 bouyer sc->sc_port_suspended_change = 1;
1019 1.1 bouyer }
1020 1.1 bouyer break;
1021 1.1 bouyer case UHF_PORT_RESET:
1022 1.1 bouyer break;
1023 1.1 bouyer case UHF_C_PORT_CONNECTION:
1024 1.1 bouyer break;
1025 1.1 bouyer case UHF_C_PORT_ENABLE:
1026 1.1 bouyer break;
1027 1.1 bouyer case UHF_C_PORT_OVER_CURRENT:
1028 1.1 bouyer break;
1029 1.1 bouyer case UHF_C_PORT_RESET:
1030 1.1 bouyer sc->sc_isreset = 0;
1031 1.1 bouyer err = USBD_NORMAL_COMPLETION;
1032 1.1 bouyer goto ret;
1033 1.1 bouyer case UHF_PORT_POWER:
1034 1.1 bouyer /* XXX todo */
1035 1.1 bouyer break;
1036 1.1 bouyer case UHF_PORT_CONNECTION:
1037 1.1 bouyer case UHF_PORT_OVER_CURRENT:
1038 1.1 bouyer case UHF_PORT_LOW_SPEED:
1039 1.1 bouyer case UHF_C_PORT_SUSPEND:
1040 1.1 bouyer default:
1041 1.1 bouyer err = USBD_IOERROR;
1042 1.1 bouyer goto ret;
1043 1.1 bouyer }
1044 1.1 bouyer break;
1045 1.1 bouyer case C(UR_GET_BUS_STATE, UT_READ_CLASS_OTHER):
1046 1.1 bouyer err = USBD_IOERROR;
1047 1.1 bouyer goto ret;
1048 1.1 bouyer case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
1049 1.1 bouyer if (len == 0)
1050 1.1 bouyer break;
1051 1.1 bouyer if ((value & 0xff) != 0) {
1052 1.1 bouyer err = USBD_IOERROR;
1053 1.1 bouyer goto ret;
1054 1.1 bouyer }
1055 1.1 bouyer l = min(len, USB_HUB_DESCRIPTOR_SIZE);
1056 1.1 bouyer totlen = l;
1057 1.1 bouyer memcpy(buf, &motg_hubd, l);
1058 1.1 bouyer break;
1059 1.1 bouyer case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
1060 1.1 bouyer if (len != 4) {
1061 1.1 bouyer err = USBD_IOERROR;
1062 1.1 bouyer goto ret;
1063 1.1 bouyer }
1064 1.1 bouyer memset(buf, 0, len);
1065 1.1 bouyer totlen = len;
1066 1.1 bouyer break;
1067 1.1 bouyer case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
1068 1.1 bouyer if (index != 1) {
1069 1.1 bouyer err = USBD_IOERROR;
1070 1.1 bouyer goto ret;
1071 1.1 bouyer }
1072 1.1 bouyer if (len != 4) {
1073 1.1 bouyer err = USBD_IOERROR;
1074 1.1 bouyer goto ret;
1075 1.1 bouyer }
1076 1.1 bouyer status = change = 0;
1077 1.1 bouyer if (sc->sc_connected)
1078 1.1 bouyer status |= UPS_CURRENT_CONNECT_STATUS;
1079 1.1 bouyer if (sc->sc_connected_changed) {
1080 1.1 bouyer change |= UPS_C_CONNECT_STATUS;
1081 1.1 bouyer sc->sc_connected_changed = 0;
1082 1.1 bouyer }
1083 1.1 bouyer if (sc->sc_port_enabled)
1084 1.1 bouyer status |= UPS_PORT_ENABLED;
1085 1.1 bouyer if (sc->sc_port_enabled_changed) {
1086 1.1 bouyer change |= UPS_C_PORT_ENABLED;
1087 1.1 bouyer sc->sc_port_enabled_changed = 0;
1088 1.1 bouyer }
1089 1.1 bouyer if (sc->sc_port_suspended)
1090 1.1 bouyer status |= UPS_SUSPEND;
1091 1.1 bouyer if (sc->sc_high_speed)
1092 1.1 bouyer status |= UPS_HIGH_SPEED;
1093 1.1 bouyer status |= UPS_PORT_POWER; /* XXX */
1094 1.1 bouyer if (sc->sc_isreset)
1095 1.1 bouyer change |= UPS_C_PORT_RESET;
1096 1.1 bouyer USETW(ps.wPortStatus, status);
1097 1.1 bouyer USETW(ps.wPortChange, change);
1098 1.1 bouyer l = min(len, sizeof ps);
1099 1.1 bouyer memcpy(buf, &ps, l);
1100 1.1 bouyer totlen = l;
1101 1.1 bouyer break;
1102 1.1 bouyer case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
1103 1.1 bouyer err = USBD_IOERROR;
1104 1.1 bouyer goto ret;
1105 1.1 bouyer case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
1106 1.1 bouyer break;
1107 1.1 bouyer case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
1108 1.1 bouyer if (index != 1) {
1109 1.1 bouyer err = USBD_IOERROR;
1110 1.1 bouyer goto ret;
1111 1.1 bouyer }
1112 1.1 bouyer switch(value) {
1113 1.1 bouyer case UHF_PORT_ENABLE:
1114 1.1 bouyer sc->sc_port_enabled = 1;
1115 1.1 bouyer break;
1116 1.1 bouyer case UHF_PORT_SUSPEND:
1117 1.1 bouyer if (sc->sc_port_suspended == 0) {
1118 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
1119 1.1 bouyer val |= MUSB2_MASK_SUSPMODE;
1120 1.1 bouyer UWRITE1(sc, MUSB2_REG_POWER, val);
1121 1.1 bouyer /* wait 20 milliseconds */
1122 1.1 bouyer usb_delay_ms(&sc->sc_bus, 20);
1123 1.1 bouyer sc->sc_port_suspended = 1;
1124 1.1 bouyer sc->sc_port_suspended_change = 1;
1125 1.1 bouyer }
1126 1.1 bouyer break;
1127 1.1 bouyer case UHF_PORT_RESET:
1128 1.1 bouyer err = motg_portreset(sc);
1129 1.1 bouyer goto ret;
1130 1.1 bouyer case UHF_PORT_POWER:
1131 1.1 bouyer /* XXX todo */
1132 1.1 bouyer err = USBD_NORMAL_COMPLETION;
1133 1.1 bouyer goto ret;
1134 1.1 bouyer case UHF_C_PORT_CONNECTION:
1135 1.1 bouyer case UHF_C_PORT_ENABLE:
1136 1.1 bouyer case UHF_C_PORT_OVER_CURRENT:
1137 1.1 bouyer case UHF_PORT_CONNECTION:
1138 1.1 bouyer case UHF_PORT_OVER_CURRENT:
1139 1.1 bouyer case UHF_PORT_LOW_SPEED:
1140 1.1 bouyer case UHF_C_PORT_SUSPEND:
1141 1.1 bouyer case UHF_C_PORT_RESET:
1142 1.1 bouyer default:
1143 1.1 bouyer err = USBD_IOERROR;
1144 1.1 bouyer goto ret;
1145 1.1 bouyer }
1146 1.1 bouyer break;
1147 1.1 bouyer default:
1148 1.1 bouyer err = USBD_IOERROR;
1149 1.1 bouyer goto ret;
1150 1.1 bouyer }
1151 1.12.2.6 skrll xfer->ux_actlen = totlen;
1152 1.1 bouyer err = USBD_NORMAL_COMPLETION;
1153 1.1 bouyer ret:
1154 1.12.2.6 skrll xfer->ux_status = err;
1155 1.1 bouyer mutex_enter(&sc->sc_lock);
1156 1.1 bouyer usb_transfer_complete(xfer);
1157 1.1 bouyer mutex_exit(&sc->sc_lock);
1158 1.1 bouyer return (USBD_IN_PROGRESS);
1159 1.1 bouyer }
1160 1.1 bouyer
1161 1.1 bouyer /* Abort a root control request. */
1162 1.1 bouyer void
1163 1.1 bouyer motg_root_ctrl_abort(usbd_xfer_handle xfer)
1164 1.1 bouyer {
1165 1.1 bouyer /* Nothing to do, all transfers are synchronous. */
1166 1.1 bouyer }
1167 1.1 bouyer
1168 1.1 bouyer /* Close the root pipe. */
1169 1.1 bouyer void
1170 1.1 bouyer motg_root_ctrl_close(usbd_pipe_handle pipe)
1171 1.1 bouyer {
1172 1.1 bouyer DPRINTFN(MD_ROOT, ("motg_root_ctrl_close\n"));
1173 1.1 bouyer }
1174 1.1 bouyer
1175 1.1 bouyer void
1176 1.1 bouyer motg_root_ctrl_done(usbd_xfer_handle xfer)
1177 1.1 bouyer {
1178 1.1 bouyer }
1179 1.1 bouyer
1180 1.1 bouyer /* Abort a root interrupt request. */
1181 1.1 bouyer void
1182 1.1 bouyer motg_root_intr_abort(usbd_xfer_handle xfer)
1183 1.1 bouyer {
1184 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1185 1.1 bouyer
1186 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1187 1.12.2.6 skrll KASSERT(xfer->ux_pipe->up_intrxfer == xfer);
1188 1.1 bouyer
1189 1.1 bouyer sc->sc_intr_xfer = NULL;
1190 1.1 bouyer
1191 1.1 bouyer #ifdef DIAGNOSTIC
1192 1.1 bouyer // XXX UXFER(xfer)->iinfo.isdone = 1;
1193 1.1 bouyer #endif
1194 1.12.2.6 skrll xfer->ux_status = USBD_CANCELLED;
1195 1.1 bouyer usb_transfer_complete(xfer);
1196 1.1 bouyer }
1197 1.1 bouyer
1198 1.1 bouyer usbd_status
1199 1.1 bouyer motg_root_intr_transfer(usbd_xfer_handle xfer)
1200 1.1 bouyer {
1201 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1202 1.1 bouyer usbd_status err;
1203 1.1 bouyer
1204 1.1 bouyer /* Insert last in queue. */
1205 1.1 bouyer mutex_enter(&sc->sc_lock);
1206 1.1 bouyer err = usb_insert_transfer(xfer);
1207 1.1 bouyer mutex_exit(&sc->sc_lock);
1208 1.1 bouyer if (err)
1209 1.1 bouyer return (err);
1210 1.1 bouyer
1211 1.1 bouyer /*
1212 1.1 bouyer * Pipe isn't running (otherwise err would be USBD_INPROG),
1213 1.1 bouyer * start first
1214 1.1 bouyer */
1215 1.12.2.6 skrll return (motg_root_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue)));
1216 1.1 bouyer }
1217 1.1 bouyer
1218 1.1 bouyer /* Start a transfer on the root interrupt pipe */
1219 1.1 bouyer usbd_status
1220 1.1 bouyer motg_root_intr_start(usbd_xfer_handle xfer)
1221 1.1 bouyer {
1222 1.12.2.6 skrll usbd_pipe_handle pipe = xfer->ux_pipe;
1223 1.12.2.6 skrll struct motg_softc *sc = pipe->up_dev->ud_bus->ub_hcpriv;
1224 1.1 bouyer
1225 1.1 bouyer DPRINTFN(MD_ROOT, ("motg_root_intr_start: xfer=%p len=%d flags=%d\n",
1226 1.12.2.6 skrll xfer, xfer->ux_length, xfer->ux_flags));
1227 1.1 bouyer
1228 1.1 bouyer if (sc->sc_dying)
1229 1.1 bouyer return (USBD_IOERROR);
1230 1.1 bouyer
1231 1.1 bouyer sc->sc_intr_xfer = xfer;
1232 1.1 bouyer return (USBD_IN_PROGRESS);
1233 1.1 bouyer }
1234 1.1 bouyer
1235 1.1 bouyer /* Close the root interrupt pipe. */
1236 1.1 bouyer void
1237 1.1 bouyer motg_root_intr_close(usbd_pipe_handle pipe)
1238 1.1 bouyer {
1239 1.12.2.6 skrll struct motg_softc *sc = pipe->up_dev->ud_bus->ub_hcpriv;
1240 1.1 bouyer
1241 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1242 1.1 bouyer
1243 1.1 bouyer sc->sc_intr_xfer = NULL;
1244 1.1 bouyer DPRINTFN(MD_ROOT, ("motg_root_intr_close\n"));
1245 1.1 bouyer }
1246 1.1 bouyer
1247 1.1 bouyer void
1248 1.1 bouyer motg_root_intr_done(usbd_xfer_handle xfer)
1249 1.1 bouyer {
1250 1.1 bouyer }
1251 1.1 bouyer
1252 1.1 bouyer void
1253 1.1 bouyer motg_noop(usbd_pipe_handle pipe)
1254 1.1 bouyer {
1255 1.1 bouyer }
1256 1.1 bouyer
1257 1.1 bouyer static usbd_status
1258 1.1 bouyer motg_portreset(struct motg_softc *sc)
1259 1.1 bouyer {
1260 1.1 bouyer uint32_t val;
1261 1.1 bouyer
1262 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
1263 1.1 bouyer val |= MUSB2_MASK_RESET;
1264 1.1 bouyer UWRITE1(sc, MUSB2_REG_POWER, val);
1265 1.1 bouyer /* Wait for 20 msec */
1266 1.1 bouyer usb_delay_ms(&sc->sc_bus, 20);
1267 1.1 bouyer
1268 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
1269 1.1 bouyer val &= ~MUSB2_MASK_RESET;
1270 1.1 bouyer UWRITE1(sc, MUSB2_REG_POWER, val);
1271 1.1 bouyer
1272 1.1 bouyer /* determine line speed */
1273 1.1 bouyer val = UREAD1(sc, MUSB2_REG_POWER);
1274 1.1 bouyer if (val & MUSB2_MASK_HSMODE)
1275 1.1 bouyer sc->sc_high_speed = 1;
1276 1.1 bouyer else
1277 1.1 bouyer sc->sc_high_speed = 0;
1278 1.1 bouyer DPRINTFN(MD_ROOT | MD_CTRL, ("motg_portreset speed %d\n",
1279 1.1 bouyer sc->sc_high_speed));
1280 1.1 bouyer
1281 1.1 bouyer sc->sc_isreset = 1;
1282 1.1 bouyer sc->sc_port_enabled = 1;
1283 1.1 bouyer return (USBD_NORMAL_COMPLETION);
1284 1.1 bouyer }
1285 1.1 bouyer
1286 1.1 bouyer /*
1287 1.1 bouyer * This routine is executed when an interrupt on the root hub is detected
1288 1.1 bouyer */
1289 1.1 bouyer static void
1290 1.1 bouyer motg_hub_change(struct motg_softc *sc)
1291 1.1 bouyer {
1292 1.1 bouyer usbd_xfer_handle xfer = sc->sc_intr_xfer;
1293 1.1 bouyer usbd_pipe_handle pipe;
1294 1.1 bouyer u_char *p;
1295 1.1 bouyer
1296 1.1 bouyer DPRINTFN(MD_ROOT, ("motg_hub_change\n"));
1297 1.1 bouyer
1298 1.1 bouyer if (xfer == NULL)
1299 1.1 bouyer return; /* the interrupt pipe is not open */
1300 1.1 bouyer
1301 1.12.2.6 skrll pipe = xfer->ux_pipe;
1302 1.12.2.6 skrll if (pipe->up_dev == NULL || pipe->up_dev->ud_bus == NULL)
1303 1.1 bouyer return; /* device has detached */
1304 1.1 bouyer
1305 1.12.2.6 skrll p = xfer->ux_buf;
1306 1.1 bouyer p[0] = 1<<1;
1307 1.12.2.6 skrll xfer->ux_actlen = 1;
1308 1.12.2.6 skrll xfer->ux_status = USBD_NORMAL_COMPLETION;
1309 1.1 bouyer usb_transfer_complete(xfer);
1310 1.1 bouyer }
1311 1.1 bouyer
1312 1.1 bouyer static uint8_t
1313 1.12.2.1 skrll motg_speed(uint8_t speed)
1314 1.1 bouyer {
1315 1.1 bouyer switch(speed) {
1316 1.1 bouyer case USB_SPEED_LOW:
1317 1.1 bouyer return MUSB2_MASK_TI_SPEED_LO;
1318 1.1 bouyer case USB_SPEED_FULL:
1319 1.1 bouyer return MUSB2_MASK_TI_SPEED_FS;
1320 1.1 bouyer case USB_SPEED_HIGH:
1321 1.1 bouyer return MUSB2_MASK_TI_SPEED_HS;
1322 1.1 bouyer default:
1323 1.1 bouyer panic("motg: unknown speed %d", speed);
1324 1.1 bouyer /* NOTREACHED */
1325 1.1 bouyer }
1326 1.1 bouyer }
1327 1.1 bouyer
1328 1.1 bouyer static uint8_t
1329 1.12.2.1 skrll motg_type(uint8_t type)
1330 1.1 bouyer {
1331 1.1 bouyer switch(type) {
1332 1.1 bouyer case UE_CONTROL:
1333 1.1 bouyer return MUSB2_MASK_TI_PROTO_CTRL;
1334 1.1 bouyer case UE_ISOCHRONOUS:
1335 1.1 bouyer return MUSB2_MASK_TI_PROTO_ISOC;
1336 1.1 bouyer case UE_BULK:
1337 1.1 bouyer return MUSB2_MASK_TI_PROTO_BULK;
1338 1.1 bouyer case UE_INTERRUPT:
1339 1.1 bouyer return MUSB2_MASK_TI_PROTO_INTR;
1340 1.1 bouyer default:
1341 1.1 bouyer panic("motg: unknown type %d", type);
1342 1.1 bouyer /* NOTREACHED */
1343 1.1 bouyer }
1344 1.1 bouyer }
1345 1.1 bouyer
1346 1.1 bouyer static void
1347 1.1 bouyer motg_setup_endpoint_tx(usbd_xfer_handle xfer)
1348 1.1 bouyer {
1349 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1350 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
1351 1.12.2.6 skrll usbd_device_handle dev = otgpipe->pipe.up_dev;
1352 1.1 bouyer int epnumber = otgpipe->hw_ep->ep_number;
1353 1.1 bouyer
1354 1.12.2.6 skrll UWRITE1(sc, MUSB2_REG_TXFADDR(epnumber), dev->ud_addr);
1355 1.12.2.6 skrll if (dev->ud_myhsport) {
1356 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXHADDR(epnumber),
1357 1.12.2.6 skrll dev->ud_myhsport->up_parent->ud_addr);
1358 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXHUBPORT(epnumber),
1359 1.12.2.6 skrll dev->ud_myhsport->up_portno);
1360 1.1 bouyer } else {
1361 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXHADDR(epnumber), 0);
1362 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXHUBPORT(epnumber), 0);
1363 1.1 bouyer }
1364 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXTI,
1365 1.12.2.6 skrll motg_speed(dev->ud_speed) |
1366 1.12.2.6 skrll UE_GET_ADDR(xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress) |
1367 1.12.2.6 skrll motg_type(UE_GET_XFERTYPE(xfer->ux_pipe->up_endpoint->ue_edesc->bmAttributes))
1368 1.1 bouyer );
1369 1.1 bouyer if (epnumber == 0) {
1370 1.1 bouyer if (sc->sc_high_speed) {
1371 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT,
1372 1.1 bouyer NAK_TO_CTRL_HIGH);
1373 1.1 bouyer } else {
1374 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT, NAK_TO_CTRL);
1375 1.1 bouyer }
1376 1.1 bouyer } else {
1377 1.12.2.6 skrll if ((xfer->ux_pipe->up_endpoint->ue_edesc->bmAttributes & UE_XFERTYPE)
1378 1.1 bouyer == UE_BULK) {
1379 1.1 bouyer if (sc->sc_high_speed) {
1380 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT,
1381 1.1 bouyer NAK_TO_BULK_HIGH);
1382 1.1 bouyer } else {
1383 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT, NAK_TO_BULK);
1384 1.1 bouyer }
1385 1.1 bouyer } else {
1386 1.1 bouyer if (sc->sc_high_speed) {
1387 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT, POLL_TO_HIGH);
1388 1.1 bouyer } else {
1389 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT, POLL_TO);
1390 1.1 bouyer }
1391 1.1 bouyer }
1392 1.1 bouyer }
1393 1.1 bouyer }
1394 1.1 bouyer
1395 1.1 bouyer static void
1396 1.1 bouyer motg_setup_endpoint_rx(usbd_xfer_handle xfer)
1397 1.1 bouyer {
1398 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1399 1.12.2.6 skrll usbd_device_handle dev = xfer->ux_pipe->up_dev;
1400 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
1401 1.1 bouyer int epnumber = otgpipe->hw_ep->ep_number;
1402 1.1 bouyer
1403 1.12.2.6 skrll UWRITE1(sc, MUSB2_REG_RXFADDR(epnumber), dev->ud_addr);
1404 1.12.2.6 skrll if (dev->ud_myhsport) {
1405 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXHADDR(epnumber),
1406 1.12.2.6 skrll dev->ud_myhsport->up_parent->ud_addr);
1407 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXHUBPORT(epnumber),
1408 1.12.2.6 skrll dev->ud_myhsport->up_portno);
1409 1.1 bouyer } else {
1410 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXHADDR(epnumber), 0);
1411 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXHUBPORT(epnumber), 0);
1412 1.1 bouyer }
1413 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXTI,
1414 1.12.2.6 skrll motg_speed(dev->ud_speed) |
1415 1.12.2.6 skrll UE_GET_ADDR(xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress) |
1416 1.12.2.6 skrll motg_type(UE_GET_XFERTYPE(xfer->ux_pipe->up_endpoint->ue_edesc->bmAttributes))
1417 1.1 bouyer );
1418 1.1 bouyer if (epnumber == 0) {
1419 1.1 bouyer if (sc->sc_high_speed) {
1420 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT,
1421 1.1 bouyer NAK_TO_CTRL_HIGH);
1422 1.1 bouyer } else {
1423 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXNAKLIMIT, NAK_TO_CTRL);
1424 1.1 bouyer }
1425 1.1 bouyer } else {
1426 1.12.2.6 skrll if ((xfer->ux_pipe->up_endpoint->ue_edesc->bmAttributes & UE_XFERTYPE)
1427 1.1 bouyer == UE_BULK) {
1428 1.1 bouyer if (sc->sc_high_speed) {
1429 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXNAKLIMIT,
1430 1.1 bouyer NAK_TO_BULK_HIGH);
1431 1.1 bouyer } else {
1432 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXNAKLIMIT, NAK_TO_BULK);
1433 1.1 bouyer }
1434 1.1 bouyer } else {
1435 1.1 bouyer if (sc->sc_high_speed) {
1436 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXNAKLIMIT, POLL_TO_HIGH);
1437 1.1 bouyer } else {
1438 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXNAKLIMIT, POLL_TO);
1439 1.1 bouyer }
1440 1.1 bouyer }
1441 1.1 bouyer }
1442 1.1 bouyer }
1443 1.1 bouyer
1444 1.1 bouyer static usbd_status
1445 1.1 bouyer motg_device_ctrl_transfer(usbd_xfer_handle xfer)
1446 1.1 bouyer {
1447 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1448 1.1 bouyer usbd_status err;
1449 1.1 bouyer
1450 1.1 bouyer /* Insert last in queue. */
1451 1.1 bouyer mutex_enter(&sc->sc_lock);
1452 1.1 bouyer err = usb_insert_transfer(xfer);
1453 1.12.2.6 skrll xfer->ux_status = USBD_NOT_STARTED;
1454 1.1 bouyer mutex_exit(&sc->sc_lock);
1455 1.1 bouyer if (err)
1456 1.1 bouyer return (err);
1457 1.1 bouyer
1458 1.1 bouyer /*
1459 1.1 bouyer * Pipe isn't running (otherwise err would be USBD_INPROG),
1460 1.1 bouyer * so start it first.
1461 1.1 bouyer */
1462 1.12.2.6 skrll return (motg_device_ctrl_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue)));
1463 1.1 bouyer }
1464 1.1 bouyer
1465 1.1 bouyer static usbd_status
1466 1.1 bouyer motg_device_ctrl_start(usbd_xfer_handle xfer)
1467 1.1 bouyer {
1468 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1469 1.1 bouyer usbd_status err;
1470 1.1 bouyer mutex_enter(&sc->sc_lock);
1471 1.1 bouyer err = motg_device_ctrl_start1(sc);
1472 1.1 bouyer mutex_exit(&sc->sc_lock);
1473 1.1 bouyer if (err != USBD_IN_PROGRESS)
1474 1.1 bouyer return err;
1475 1.12.2.6 skrll if (sc->sc_bus.ub_usepolling)
1476 1.1 bouyer motg_waitintr(sc, xfer);
1477 1.1 bouyer return USBD_IN_PROGRESS;
1478 1.1 bouyer }
1479 1.1 bouyer
1480 1.1 bouyer static usbd_status
1481 1.1 bouyer motg_device_ctrl_start1(struct motg_softc *sc)
1482 1.1 bouyer {
1483 1.1 bouyer struct motg_hw_ep *ep = &sc->sc_in_ep[0];
1484 1.3 bouyer usbd_xfer_handle xfer = NULL;
1485 1.1 bouyer struct motg_pipe *otgpipe;
1486 1.1 bouyer usbd_status err = 0;
1487 1.1 bouyer
1488 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1489 1.1 bouyer if (sc->sc_dying)
1490 1.1 bouyer return (USBD_IOERROR);
1491 1.1 bouyer
1492 1.1 bouyer if (!sc->sc_connected)
1493 1.1 bouyer return (USBD_IOERROR);
1494 1.1 bouyer
1495 1.1 bouyer if (ep->xfer != NULL) {
1496 1.1 bouyer err = USBD_IN_PROGRESS;
1497 1.1 bouyer goto end;
1498 1.1 bouyer }
1499 1.1 bouyer /* locate the first pipe with work to do */
1500 1.1 bouyer SIMPLEQ_FOREACH(otgpipe, &ep->ep_pipes, ep_pipe_list) {
1501 1.12.2.6 skrll xfer = SIMPLEQ_FIRST(&otgpipe->pipe.up_queue);
1502 1.3 bouyer DPRINTFN(MD_CTRL,
1503 1.3 bouyer ("motg_device_ctrl_start1 pipe %p xfer %p status %d\n",
1504 1.12.2.6 skrll otgpipe, xfer, (xfer != NULL) ? xfer->ux_status : 0));
1505 1.7 skrll
1506 1.1 bouyer if (xfer != NULL) {
1507 1.1 bouyer /* move this pipe to the end of the list */
1508 1.1 bouyer SIMPLEQ_REMOVE(&ep->ep_pipes, otgpipe,
1509 1.1 bouyer motg_pipe, ep_pipe_list);
1510 1.1 bouyer SIMPLEQ_INSERT_TAIL(&ep->ep_pipes,
1511 1.1 bouyer otgpipe, ep_pipe_list);
1512 1.1 bouyer break;
1513 1.1 bouyer }
1514 1.1 bouyer }
1515 1.1 bouyer if (xfer == NULL) {
1516 1.1 bouyer err = USBD_NOT_STARTED;
1517 1.1 bouyer goto end;
1518 1.1 bouyer }
1519 1.12.2.6 skrll xfer->ux_status = USBD_IN_PROGRESS;
1520 1.12.2.6 skrll KASSERT(otgpipe == (struct motg_pipe *)xfer->ux_pipe);
1521 1.1 bouyer KASSERT(otgpipe->hw_ep == ep);
1522 1.1 bouyer #ifdef DIAGNOSTIC
1523 1.12.2.6 skrll if (!(xfer->ux_rqflags & URQ_REQUEST))
1524 1.1 bouyer panic("motg_device_ctrl_transfer: not a request");
1525 1.1 bouyer #endif
1526 1.12.2.6 skrll // KASSERT(xfer->ux_actlen == 0);
1527 1.12.2.6 skrll xfer->ux_actlen = 0;
1528 1.1 bouyer
1529 1.1 bouyer ep->xfer = xfer;
1530 1.12.2.6 skrll ep->datalen = xfer->ux_length;
1531 1.1 bouyer if (ep->datalen > 0)
1532 1.12.2.6 skrll ep->data = xfer->ux_buf;
1533 1.1 bouyer else
1534 1.1 bouyer ep->data = NULL;
1535 1.12.2.6 skrll if ((xfer->ux_flags & USBD_FORCE_SHORT_XFER) &&
1536 1.1 bouyer (ep->datalen % 64) == 0)
1537 1.1 bouyer ep->need_short_xfer = 1;
1538 1.1 bouyer else
1539 1.1 bouyer ep->need_short_xfer = 0;
1540 1.1 bouyer /* now we need send this request */
1541 1.7 skrll DPRINTFN(MD_CTRL,
1542 1.1 bouyer ("motg_device_ctrl_start1(%p) send data %p len %d short %d speed %d to %d\n",
1543 1.12.2.6 skrll xfer, ep->data, ep->datalen, ep->need_short_xfer, xfer->ux_pipe->up_dev->ud_speed,
1544 1.12.2.6 skrll xfer->ux_pipe->up_dev->ud_addr));
1545 1.1 bouyer KASSERT(ep->phase == IDLE);
1546 1.1 bouyer ep->phase = SETUP;
1547 1.1 bouyer /* select endpoint 0 */
1548 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, 0);
1549 1.1 bouyer /* fifo should be empty at this point */
1550 1.1 bouyer KASSERT((UREAD1(sc, MUSB2_REG_TXCSRL) & MUSB2_MASK_CSR0L_TXPKTRDY) == 0);
1551 1.1 bouyer /* send data */
1552 1.12.2.6 skrll // KASSERT(((vaddr_t)(&xfer->ux_request) & 3) == 0);
1553 1.12.2.6 skrll KASSERT(sizeof(xfer->ux_request) == 8);
1554 1.1 bouyer bus_space_write_multi_1(sc->sc_iot, sc->sc_ioh, MUSB2_REG_EPFIFO(0),
1555 1.12.2.6 skrll (void *)&xfer->ux_request, sizeof(xfer->ux_request));
1556 1.1 bouyer
1557 1.1 bouyer motg_setup_endpoint_tx(xfer);
1558 1.1 bouyer /* start transaction */
1559 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL,
1560 1.1 bouyer MUSB2_MASK_CSR0L_TXPKTRDY | MUSB2_MASK_CSR0L_SETUPPKT);
1561 1.1 bouyer
1562 1.1 bouyer end:
1563 1.1 bouyer if (err)
1564 1.1 bouyer return (err);
1565 1.1 bouyer
1566 1.1 bouyer return (USBD_IN_PROGRESS);
1567 1.1 bouyer }
1568 1.1 bouyer
1569 1.1 bouyer static void
1570 1.1 bouyer motg_device_ctrl_read(usbd_xfer_handle xfer)
1571 1.1 bouyer {
1572 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1573 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
1574 1.1 bouyer /* assume endpoint already selected */
1575 1.1 bouyer motg_setup_endpoint_rx(xfer);
1576 1.1 bouyer /* start transaction */
1577 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, MUSB2_MASK_CSR0L_REQPKT);
1578 1.1 bouyer otgpipe->hw_ep->phase = DATA_IN;
1579 1.1 bouyer }
1580 1.1 bouyer
1581 1.1 bouyer static void
1582 1.1 bouyer motg_device_ctrl_intr_rx(struct motg_softc *sc)
1583 1.1 bouyer {
1584 1.1 bouyer struct motg_hw_ep *ep = &sc->sc_in_ep[0];
1585 1.1 bouyer usbd_xfer_handle xfer = ep->xfer;
1586 1.1 bouyer uint8_t csr;
1587 1.1 bouyer int datalen, max_datalen;
1588 1.1 bouyer char *data;
1589 1.1 bouyer bool got_short;
1590 1.3 bouyer usbd_status new_status = USBD_IN_PROGRESS;
1591 1.1 bouyer
1592 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1593 1.1 bouyer
1594 1.1 bouyer #ifdef DIAGNOSTIC
1595 1.1 bouyer if (ep->phase != DATA_IN &&
1596 1.1 bouyer ep->phase != STATUS_IN)
1597 1.1 bouyer panic("motg_device_ctrl_intr_rx: bad phase %d", ep->phase);
1598 1.1 bouyer #endif
1599 1.12.2.2 skrll /* select endpoint 0 */
1600 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, 0);
1601 1.1 bouyer
1602 1.1 bouyer /* read out FIFO status */
1603 1.1 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
1604 1.7 skrll DPRINTFN(MD_CTRL,
1605 1.7 skrll ("motg_device_ctrl_intr_rx phase %d csr 0x%x xfer %p status %d\n",
1606 1.12.2.6 skrll ep->phase, csr, xfer, (xfer != NULL) ? xfer->ux_status : 0));
1607 1.1 bouyer
1608 1.1 bouyer if (csr & MUSB2_MASK_CSR0L_NAKTIMO) {
1609 1.1 bouyer csr &= ~MUSB2_MASK_CSR0L_REQPKT;
1610 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr);
1611 1.1 bouyer
1612 1.1 bouyer csr &= ~MUSB2_MASK_CSR0L_NAKTIMO;
1613 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr);
1614 1.3 bouyer new_status = USBD_TIMEOUT; /* XXX */
1615 1.1 bouyer goto complete;
1616 1.1 bouyer }
1617 1.1 bouyer if (csr & (MUSB2_MASK_CSR0L_RXSTALL | MUSB2_MASK_CSR0L_ERROR)) {
1618 1.3 bouyer if (csr & MUSB2_MASK_CSR0L_RXSTALL)
1619 1.3 bouyer new_status = USBD_STALLED;
1620 1.3 bouyer else
1621 1.3 bouyer new_status = USBD_IOERROR;
1622 1.1 bouyer /* clear status */
1623 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
1624 1.1 bouyer goto complete;
1625 1.1 bouyer }
1626 1.1 bouyer if ((csr & MUSB2_MASK_CSR0L_RXPKTRDY) == 0)
1627 1.1 bouyer return; /* no data yet */
1628 1.1 bouyer
1629 1.12.2.6 skrll if (xfer == NULL || xfer->ux_status != USBD_IN_PROGRESS)
1630 1.1 bouyer goto complete;
1631 1.1 bouyer
1632 1.1 bouyer if (ep->phase == STATUS_IN) {
1633 1.3 bouyer new_status = USBD_NORMAL_COMPLETION;
1634 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
1635 1.1 bouyer goto complete;
1636 1.1 bouyer }
1637 1.1 bouyer datalen = UREAD2(sc, MUSB2_REG_RXCOUNT);
1638 1.7 skrll DPRINTFN(MD_CTRL,
1639 1.7 skrll ("motg_device_ctrl_intr_rx phase %d datalen %d\n",
1640 1.1 bouyer ep->phase, datalen));
1641 1.12.2.6 skrll KASSERT(UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize) > 0);
1642 1.12.2.6 skrll max_datalen = min(UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize),
1643 1.1 bouyer ep->datalen);
1644 1.1 bouyer if (datalen > max_datalen) {
1645 1.3 bouyer new_status = USBD_IOERROR;
1646 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
1647 1.1 bouyer goto complete;
1648 1.1 bouyer }
1649 1.1 bouyer got_short = (datalen < max_datalen);
1650 1.1 bouyer if (datalen > 0) {
1651 1.1 bouyer KASSERT(ep->phase == DATA_IN);
1652 1.1 bouyer data = ep->data;
1653 1.1 bouyer ep->data += datalen;
1654 1.1 bouyer ep->datalen -= datalen;
1655 1.12.2.6 skrll xfer->ux_actlen += datalen;
1656 1.1 bouyer if (((vaddr_t)data & 0x3) == 0 &&
1657 1.1 bouyer (datalen >> 2) > 0) {
1658 1.7 skrll DPRINTFN(MD_CTRL,
1659 1.1 bouyer ("motg_device_ctrl_intr_rx r4 data %p len %d\n",
1660 1.1 bouyer data, datalen));
1661 1.1 bouyer bus_space_read_multi_4(sc->sc_iot, sc->sc_ioh,
1662 1.1 bouyer MUSB2_REG_EPFIFO(0), (void *)data, datalen >> 2);
1663 1.1 bouyer data += (datalen & ~0x3);
1664 1.1 bouyer datalen -= (datalen & ~0x3);
1665 1.1 bouyer }
1666 1.7 skrll DPRINTFN(MD_CTRL,
1667 1.1 bouyer ("motg_device_ctrl_intr_rx r1 data %p len %d\n",
1668 1.1 bouyer data, datalen));
1669 1.1 bouyer if (datalen) {
1670 1.1 bouyer bus_space_read_multi_1(sc->sc_iot, sc->sc_ioh,
1671 1.1 bouyer MUSB2_REG_EPFIFO(0), data, datalen);
1672 1.1 bouyer }
1673 1.1 bouyer }
1674 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr & ~MUSB2_MASK_CSR0L_RXPKTRDY);
1675 1.1 bouyer KASSERT(ep->phase == DATA_IN);
1676 1.1 bouyer if (got_short || (ep->datalen == 0)) {
1677 1.1 bouyer if (ep->need_short_xfer == 0) {
1678 1.1 bouyer ep->phase = STATUS_OUT;
1679 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRH,
1680 1.1 bouyer UREAD1(sc, MUSB2_REG_TXCSRH) |
1681 1.1 bouyer MUSB2_MASK_CSR0H_PING_DIS);
1682 1.1 bouyer motg_setup_endpoint_tx(xfer);
1683 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL,
1684 1.1 bouyer MUSB2_MASK_CSR0L_STATUSPKT |
1685 1.1 bouyer MUSB2_MASK_CSR0L_TXPKTRDY);
1686 1.1 bouyer return;
1687 1.1 bouyer }
1688 1.1 bouyer ep->need_short_xfer = 0;
1689 1.1 bouyer }
1690 1.1 bouyer motg_device_ctrl_read(xfer);
1691 1.1 bouyer return;
1692 1.1 bouyer complete:
1693 1.1 bouyer ep->phase = IDLE;
1694 1.1 bouyer ep->xfer = NULL;
1695 1.12.2.6 skrll if (xfer && xfer->ux_status == USBD_IN_PROGRESS) {
1696 1.3 bouyer KASSERT(new_status != USBD_IN_PROGRESS);
1697 1.12.2.6 skrll xfer->ux_status = new_status;
1698 1.1 bouyer usb_transfer_complete(xfer);
1699 1.3 bouyer }
1700 1.1 bouyer motg_device_ctrl_start1(sc);
1701 1.1 bouyer }
1702 1.1 bouyer
1703 1.1 bouyer static void
1704 1.1 bouyer motg_device_ctrl_intr_tx(struct motg_softc *sc)
1705 1.1 bouyer {
1706 1.1 bouyer struct motg_hw_ep *ep = &sc->sc_in_ep[0];
1707 1.1 bouyer usbd_xfer_handle xfer = ep->xfer;
1708 1.1 bouyer uint8_t csr;
1709 1.1 bouyer int datalen;
1710 1.1 bouyer char *data;
1711 1.3 bouyer usbd_status new_status = USBD_IN_PROGRESS;
1712 1.1 bouyer
1713 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1714 1.1 bouyer if (ep->phase == DATA_IN || ep->phase == STATUS_IN) {
1715 1.1 bouyer motg_device_ctrl_intr_rx(sc);
1716 1.1 bouyer return;
1717 1.1 bouyer }
1718 1.1 bouyer
1719 1.1 bouyer #ifdef DIAGNOSTIC
1720 1.1 bouyer if (ep->phase != SETUP && ep->phase != DATA_OUT &&
1721 1.1 bouyer ep->phase != STATUS_OUT)
1722 1.1 bouyer panic("motg_device_ctrl_intr_tx: bad phase %d", ep->phase);
1723 1.1 bouyer #endif
1724 1.12.2.2 skrll /* select endpoint 0 */
1725 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, 0);
1726 1.1 bouyer
1727 1.1 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
1728 1.7 skrll DPRINTFN(MD_CTRL,
1729 1.7 skrll ("motg_device_ctrl_intr_tx phase %d csr 0x%x xfer %p status %d\n",
1730 1.12.2.6 skrll ep->phase, csr, xfer, (xfer != NULL) ? xfer->ux_status : 0));
1731 1.1 bouyer
1732 1.1 bouyer if (csr & MUSB2_MASK_CSR0L_RXSTALL) {
1733 1.1 bouyer /* command not accepted */
1734 1.3 bouyer new_status = USBD_STALLED;
1735 1.1 bouyer /* clear status */
1736 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
1737 1.1 bouyer goto complete;
1738 1.1 bouyer }
1739 1.1 bouyer if (csr & MUSB2_MASK_CSR0L_NAKTIMO) {
1740 1.3 bouyer new_status = USBD_TIMEOUT; /* XXX */
1741 1.1 bouyer /* flush fifo */
1742 1.1 bouyer while (csr & MUSB2_MASK_CSR0L_TXFIFONEMPTY) {
1743 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRH,
1744 1.7 skrll UREAD1(sc, MUSB2_REG_TXCSRH) |
1745 1.1 bouyer MUSB2_MASK_CSR0H_FFLUSH);
1746 1.1 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
1747 1.1 bouyer }
1748 1.1 bouyer csr &= ~MUSB2_MASK_CSR0L_NAKTIMO;
1749 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr);
1750 1.1 bouyer goto complete;
1751 1.1 bouyer }
1752 1.1 bouyer if (csr & MUSB2_MASK_CSR0L_ERROR) {
1753 1.3 bouyer new_status = USBD_IOERROR;
1754 1.1 bouyer /* clear status */
1755 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
1756 1.1 bouyer goto complete;
1757 1.1 bouyer }
1758 1.1 bouyer if (csr & MUSB2_MASK_CSR0L_TXFIFONEMPTY) {
1759 1.1 bouyer /* data still not sent */
1760 1.1 bouyer return;
1761 1.1 bouyer }
1762 1.1 bouyer if (xfer == NULL)
1763 1.1 bouyer goto complete;
1764 1.1 bouyer if (ep->phase == STATUS_OUT) {
1765 1.1 bouyer /*
1766 1.1 bouyer * we have sent status and got no error;
1767 1.1 bouyer * declare transfer complete
1768 1.1 bouyer */
1769 1.7 skrll DPRINTFN(MD_CTRL,
1770 1.3 bouyer ("motg_device_ctrl_intr_tx %p status %d complete\n",
1771 1.12.2.6 skrll xfer, xfer->ux_status));
1772 1.3 bouyer new_status = USBD_NORMAL_COMPLETION;
1773 1.1 bouyer goto complete;
1774 1.1 bouyer }
1775 1.1 bouyer if (ep->datalen == 0) {
1776 1.1 bouyer if (ep->need_short_xfer) {
1777 1.1 bouyer ep->need_short_xfer = 0;
1778 1.1 bouyer /* one more data phase */
1779 1.12.2.6 skrll if (xfer->ux_request.bmRequestType & UT_READ) {
1780 1.7 skrll DPRINTFN(MD_CTRL,
1781 1.1 bouyer ("motg_device_ctrl_intr_tx %p to DATA_IN\n", xfer));
1782 1.1 bouyer motg_device_ctrl_read(xfer);
1783 1.1 bouyer return;
1784 1.1 bouyer } /* else fall back to DATA_OUT */
1785 1.1 bouyer } else {
1786 1.7 skrll DPRINTFN(MD_CTRL,
1787 1.1 bouyer ("motg_device_ctrl_intr_tx %p to STATUS_IN, csrh 0x%x\n",
1788 1.1 bouyer xfer, UREAD1(sc, MUSB2_REG_TXCSRH)));
1789 1.1 bouyer ep->phase = STATUS_IN;
1790 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRH,
1791 1.1 bouyer UREAD1(sc, MUSB2_REG_RXCSRH) |
1792 1.1 bouyer MUSB2_MASK_CSR0H_PING_DIS);
1793 1.1 bouyer motg_setup_endpoint_rx(xfer);
1794 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL,
1795 1.1 bouyer MUSB2_MASK_CSR0L_STATUSPKT |
1796 1.1 bouyer MUSB2_MASK_CSR0L_REQPKT);
1797 1.1 bouyer return;
1798 1.1 bouyer }
1799 1.1 bouyer }
1800 1.12.2.6 skrll if (xfer->ux_request.bmRequestType & UT_READ) {
1801 1.1 bouyer motg_device_ctrl_read(xfer);
1802 1.1 bouyer return;
1803 1.1 bouyer }
1804 1.1 bouyer /* setup a dataout phase */
1805 1.1 bouyer datalen = min(ep->datalen,
1806 1.12.2.6 skrll UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize));
1807 1.1 bouyer ep->phase = DATA_OUT;
1808 1.7 skrll DPRINTFN(MD_CTRL,
1809 1.1 bouyer ("motg_device_ctrl_intr_tx %p to DATA_OUT, csrh 0x%x\n", xfer,
1810 1.1 bouyer UREAD1(sc, MUSB2_REG_TXCSRH)));
1811 1.1 bouyer if (datalen) {
1812 1.1 bouyer data = ep->data;
1813 1.1 bouyer ep->data += datalen;
1814 1.1 bouyer ep->datalen -= datalen;
1815 1.12.2.6 skrll xfer->ux_actlen += datalen;
1816 1.1 bouyer if (((vaddr_t)data & 0x3) == 0 &&
1817 1.1 bouyer (datalen >> 2) > 0) {
1818 1.1 bouyer bus_space_write_multi_4(sc->sc_iot, sc->sc_ioh,
1819 1.1 bouyer MUSB2_REG_EPFIFO(0), (void *)data, datalen >> 2);
1820 1.1 bouyer data += (datalen & ~0x3);
1821 1.1 bouyer datalen -= (datalen & ~0x3);
1822 1.1 bouyer }
1823 1.1 bouyer if (datalen) {
1824 1.1 bouyer bus_space_write_multi_1(sc->sc_iot, sc->sc_ioh,
1825 1.1 bouyer MUSB2_REG_EPFIFO(0), data, datalen);
1826 1.1 bouyer }
1827 1.1 bouyer }
1828 1.1 bouyer /* send data */
1829 1.1 bouyer motg_setup_endpoint_tx(xfer);
1830 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, MUSB2_MASK_CSR0L_TXPKTRDY);
1831 1.1 bouyer return;
1832 1.1 bouyer
1833 1.1 bouyer complete:
1834 1.1 bouyer ep->phase = IDLE;
1835 1.1 bouyer ep->xfer = NULL;
1836 1.12.2.6 skrll if (xfer && xfer->ux_status == USBD_IN_PROGRESS) {
1837 1.3 bouyer KASSERT(new_status != USBD_IN_PROGRESS);
1838 1.12.2.6 skrll xfer->ux_status = new_status;
1839 1.1 bouyer usb_transfer_complete(xfer);
1840 1.3 bouyer }
1841 1.1 bouyer motg_device_ctrl_start1(sc);
1842 1.1 bouyer }
1843 1.1 bouyer
1844 1.1 bouyer /* Abort a device control request. */
1845 1.1 bouyer void
1846 1.1 bouyer motg_device_ctrl_abort(usbd_xfer_handle xfer)
1847 1.1 bouyer {
1848 1.1 bouyer DPRINTFN(MD_CTRL, ("motg_device_ctrl_abort:\n"));
1849 1.3 bouyer motg_device_xfer_abort(xfer);
1850 1.1 bouyer }
1851 1.1 bouyer
1852 1.1 bouyer /* Close a device control pipe */
1853 1.1 bouyer void
1854 1.1 bouyer motg_device_ctrl_close(usbd_pipe_handle pipe)
1855 1.1 bouyer {
1856 1.12.2.6 skrll struct motg_softc *sc __diagused = pipe->up_dev->ud_bus->ub_hcpriv;
1857 1.1 bouyer struct motg_pipe *otgpipe = (struct motg_pipe *)pipe;
1858 1.1 bouyer struct motg_pipe *otgpipeiter;
1859 1.1 bouyer
1860 1.1 bouyer DPRINTFN(MD_CTRL, ("motg_device_ctrl_close:\n"));
1861 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1862 1.1 bouyer KASSERT(otgpipe->hw_ep->xfer == NULL ||
1863 1.12.2.6 skrll otgpipe->hw_ep->xfer->ux_pipe != pipe);
1864 1.1 bouyer
1865 1.1 bouyer SIMPLEQ_FOREACH(otgpipeiter, &otgpipe->hw_ep->ep_pipes, ep_pipe_list) {
1866 1.1 bouyer if (otgpipeiter == otgpipe) {
1867 1.1 bouyer /* remove from list */
1868 1.1 bouyer SIMPLEQ_REMOVE(&otgpipe->hw_ep->ep_pipes, otgpipe,
1869 1.1 bouyer motg_pipe, ep_pipe_list);
1870 1.1 bouyer otgpipe->hw_ep->refcount--;
1871 1.1 bouyer /* we're done */
1872 1.1 bouyer return;
1873 1.1 bouyer }
1874 1.1 bouyer }
1875 1.1 bouyer panic("motg_device_ctrl_close: not found");
1876 1.1 bouyer }
1877 1.1 bouyer
1878 1.1 bouyer void
1879 1.1 bouyer motg_device_ctrl_done(usbd_xfer_handle xfer)
1880 1.1 bouyer {
1881 1.12.2.6 skrll struct motg_pipe *otgpipe __diagused = (struct motg_pipe *)xfer->ux_pipe;
1882 1.1 bouyer DPRINTFN(MD_CTRL, ("motg_device_ctrl_done:\n"));
1883 1.1 bouyer KASSERT(otgpipe->hw_ep->xfer != xfer);
1884 1.1 bouyer }
1885 1.1 bouyer
1886 1.1 bouyer static usbd_status
1887 1.1 bouyer motg_device_data_transfer(usbd_xfer_handle xfer)
1888 1.1 bouyer {
1889 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1890 1.1 bouyer usbd_status err;
1891 1.1 bouyer
1892 1.1 bouyer /* Insert last in queue. */
1893 1.1 bouyer mutex_enter(&sc->sc_lock);
1894 1.3 bouyer DPRINTF(("motg_device_data_transfer(%p) status %d\n",
1895 1.12.2.6 skrll xfer, xfer->ux_status));
1896 1.1 bouyer err = usb_insert_transfer(xfer);
1897 1.12.2.6 skrll xfer->ux_status = USBD_NOT_STARTED;
1898 1.1 bouyer mutex_exit(&sc->sc_lock);
1899 1.1 bouyer if (err)
1900 1.1 bouyer return (err);
1901 1.1 bouyer
1902 1.1 bouyer /*
1903 1.1 bouyer * Pipe isn't running (otherwise err would be USBD_INPROG),
1904 1.1 bouyer * so start it first.
1905 1.1 bouyer */
1906 1.12.2.6 skrll return (motg_device_data_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue)));
1907 1.1 bouyer }
1908 1.1 bouyer
1909 1.1 bouyer static usbd_status
1910 1.1 bouyer motg_device_data_start(usbd_xfer_handle xfer)
1911 1.1 bouyer {
1912 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
1913 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
1914 1.1 bouyer usbd_status err;
1915 1.1 bouyer mutex_enter(&sc->sc_lock);
1916 1.3 bouyer DPRINTF(("motg_device_data_start(%p) status %d\n",
1917 1.12.2.6 skrll xfer, xfer->ux_status));
1918 1.1 bouyer err = motg_device_data_start1(sc, otgpipe->hw_ep);
1919 1.1 bouyer mutex_exit(&sc->sc_lock);
1920 1.1 bouyer if (err != USBD_IN_PROGRESS)
1921 1.1 bouyer return err;
1922 1.12.2.6 skrll if (sc->sc_bus.ub_usepolling)
1923 1.1 bouyer motg_waitintr(sc, xfer);
1924 1.1 bouyer return USBD_IN_PROGRESS;
1925 1.1 bouyer }
1926 1.1 bouyer
1927 1.1 bouyer static usbd_status
1928 1.1 bouyer motg_device_data_start1(struct motg_softc *sc, struct motg_hw_ep *ep)
1929 1.1 bouyer {
1930 1.3 bouyer usbd_xfer_handle xfer = NULL;
1931 1.1 bouyer struct motg_pipe *otgpipe;
1932 1.1 bouyer usbd_status err = 0;
1933 1.8 skrll uint32_t val __diagused;
1934 1.1 bouyer
1935 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
1936 1.1 bouyer if (sc->sc_dying)
1937 1.1 bouyer return (USBD_IOERROR);
1938 1.1 bouyer
1939 1.1 bouyer if (!sc->sc_connected)
1940 1.1 bouyer return (USBD_IOERROR);
1941 1.1 bouyer
1942 1.1 bouyer if (ep->xfer != NULL) {
1943 1.1 bouyer err = USBD_IN_PROGRESS;
1944 1.1 bouyer goto end;
1945 1.1 bouyer }
1946 1.1 bouyer /* locate the first pipe with work to do */
1947 1.1 bouyer SIMPLEQ_FOREACH(otgpipe, &ep->ep_pipes, ep_pipe_list) {
1948 1.12.2.6 skrll xfer = SIMPLEQ_FIRST(&otgpipe->pipe.up_queue);
1949 1.3 bouyer DPRINTFN(MD_BULK,
1950 1.3 bouyer ("motg_device_data_start1 pipe %p xfer %p status %d\n",
1951 1.12.2.6 skrll otgpipe, xfer, (xfer != NULL) ? xfer->ux_status : 0));
1952 1.1 bouyer if (xfer != NULL) {
1953 1.1 bouyer /* move this pipe to the end of the list */
1954 1.1 bouyer SIMPLEQ_REMOVE(&ep->ep_pipes, otgpipe,
1955 1.1 bouyer motg_pipe, ep_pipe_list);
1956 1.1 bouyer SIMPLEQ_INSERT_TAIL(&ep->ep_pipes,
1957 1.1 bouyer otgpipe, ep_pipe_list);
1958 1.1 bouyer break;
1959 1.1 bouyer }
1960 1.1 bouyer }
1961 1.1 bouyer if (xfer == NULL) {
1962 1.1 bouyer err = USBD_NOT_STARTED;
1963 1.1 bouyer goto end;
1964 1.1 bouyer }
1965 1.12.2.6 skrll xfer->ux_status = USBD_IN_PROGRESS;
1966 1.12.2.6 skrll KASSERT(otgpipe == (struct motg_pipe *)xfer->ux_pipe);
1967 1.1 bouyer KASSERT(otgpipe->hw_ep == ep);
1968 1.1 bouyer #ifdef DIAGNOSTIC
1969 1.12.2.6 skrll if (xfer->ux_rqflags & URQ_REQUEST)
1970 1.1 bouyer panic("motg_device_data_transfer: a request");
1971 1.1 bouyer #endif
1972 1.12.2.6 skrll // KASSERT(xfer->ux_actlen == 0);
1973 1.12.2.6 skrll xfer->ux_actlen = 0;
1974 1.1 bouyer
1975 1.1 bouyer ep->xfer = xfer;
1976 1.12.2.6 skrll ep->datalen = xfer->ux_length;
1977 1.1 bouyer KASSERT(ep->datalen > 0);
1978 1.12.2.6 skrll ep->data = xfer->ux_buf;
1979 1.12.2.6 skrll if ((xfer->ux_flags & USBD_FORCE_SHORT_XFER) &&
1980 1.1 bouyer (ep->datalen % 64) == 0)
1981 1.1 bouyer ep->need_short_xfer = 1;
1982 1.1 bouyer else
1983 1.1 bouyer ep->need_short_xfer = 0;
1984 1.1 bouyer /* now we need send this request */
1985 1.7 skrll DPRINTFN(MD_BULK,
1986 1.1 bouyer ("motg_device_data_start1(%p) %s data %p len %d short %d speed %d to %d\n",
1987 1.7 skrll xfer,
1988 1.12.2.6 skrll UE_GET_DIR(xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress) == UE_DIR_IN ? "read" : "write",
1989 1.12.2.6 skrll ep->data, ep->datalen, ep->need_short_xfer, xfer->ux_pipe->up_dev->ud_speed,
1990 1.12.2.6 skrll xfer->ux_pipe->up_dev->ud_addr));
1991 1.1 bouyer KASSERT(ep->phase == IDLE);
1992 1.1 bouyer /* select endpoint */
1993 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, ep->ep_number);
1994 1.12.2.6 skrll if (UE_GET_DIR(xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress)
1995 1.1 bouyer == UE_DIR_IN) {
1996 1.1 bouyer val = UREAD1(sc, MUSB2_REG_RXCSRL);
1997 1.1 bouyer KASSERT((val & MUSB2_MASK_CSRL_RXPKTRDY) == 0);
1998 1.1 bouyer motg_device_data_read(xfer);
1999 1.1 bouyer } else {
2000 1.1 bouyer ep->phase = DATA_OUT;
2001 1.1 bouyer val = UREAD1(sc, MUSB2_REG_TXCSRL);
2002 1.1 bouyer KASSERT((val & MUSB2_MASK_CSRL_TXPKTRDY) == 0);
2003 1.1 bouyer motg_device_data_write(xfer);
2004 1.1 bouyer }
2005 1.1 bouyer end:
2006 1.1 bouyer if (err)
2007 1.1 bouyer return (err);
2008 1.1 bouyer
2009 1.1 bouyer return (USBD_IN_PROGRESS);
2010 1.1 bouyer }
2011 1.1 bouyer
2012 1.1 bouyer static void
2013 1.1 bouyer motg_device_data_read(usbd_xfer_handle xfer)
2014 1.1 bouyer {
2015 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
2016 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
2017 1.1 bouyer uint32_t val;
2018 1.1 bouyer
2019 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2020 1.1 bouyer /* assume endpoint already selected */
2021 1.1 bouyer motg_setup_endpoint_rx(xfer);
2022 1.1 bouyer /* Max packet size */
2023 1.1 bouyer UWRITE2(sc, MUSB2_REG_RXMAXP,
2024 1.12.2.6 skrll UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize));
2025 1.1 bouyer /* Data Toggle */
2026 1.1 bouyer val = UREAD1(sc, MUSB2_REG_RXCSRH);
2027 1.1 bouyer val |= MUSB2_MASK_CSRH_RXDT_WREN;
2028 1.1 bouyer if (otgpipe->nexttoggle)
2029 1.1 bouyer val |= MUSB2_MASK_CSRH_RXDT_VAL;
2030 1.1 bouyer else
2031 1.1 bouyer val &= ~MUSB2_MASK_CSRH_RXDT_VAL;
2032 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRH, val);
2033 1.1 bouyer
2034 1.7 skrll DPRINTFN(MD_BULK,
2035 1.1 bouyer ("motg_device_data_read %p to DATA_IN on ep %d, csrh 0x%x\n",
2036 1.1 bouyer xfer, otgpipe->hw_ep->ep_number, UREAD1(sc, MUSB2_REG_RXCSRH)));
2037 1.1 bouyer /* start transaction */
2038 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, MUSB2_MASK_CSRL_RXREQPKT);
2039 1.1 bouyer otgpipe->hw_ep->phase = DATA_IN;
2040 1.1 bouyer }
2041 1.1 bouyer
2042 1.1 bouyer static void
2043 1.1 bouyer motg_device_data_write(usbd_xfer_handle xfer)
2044 1.1 bouyer {
2045 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
2046 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
2047 1.1 bouyer struct motg_hw_ep *ep = otgpipe->hw_ep;
2048 1.1 bouyer int datalen;
2049 1.1 bouyer char *data;
2050 1.1 bouyer uint32_t val;
2051 1.1 bouyer
2052 1.1 bouyer KASSERT(xfer!=NULL);
2053 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2054 1.1 bouyer
2055 1.1 bouyer datalen = min(ep->datalen,
2056 1.12.2.6 skrll UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize));
2057 1.1 bouyer ep->phase = DATA_OUT;
2058 1.7 skrll DPRINTFN(MD_BULK,
2059 1.1 bouyer ("motg_device_data_write %p to DATA_OUT on ep %d, len %d csrh 0x%x\n",
2060 1.1 bouyer xfer, ep->ep_number, datalen, UREAD1(sc, MUSB2_REG_TXCSRH)));
2061 1.1 bouyer
2062 1.1 bouyer /* assume endpoint already selected */
2063 1.1 bouyer /* write data to fifo */
2064 1.1 bouyer data = ep->data;
2065 1.1 bouyer ep->data += datalen;
2066 1.1 bouyer ep->datalen -= datalen;
2067 1.12.2.6 skrll xfer->ux_actlen += datalen;
2068 1.1 bouyer if (((vaddr_t)data & 0x3) == 0 &&
2069 1.1 bouyer (datalen >> 2) > 0) {
2070 1.1 bouyer bus_space_write_multi_4(sc->sc_iot, sc->sc_ioh,
2071 1.1 bouyer MUSB2_REG_EPFIFO(ep->ep_number),
2072 1.1 bouyer (void *)data, datalen >> 2);
2073 1.1 bouyer data += (datalen & ~0x3);
2074 1.1 bouyer datalen -= (datalen & ~0x3);
2075 1.1 bouyer }
2076 1.1 bouyer if (datalen) {
2077 1.1 bouyer bus_space_write_multi_1(sc->sc_iot, sc->sc_ioh,
2078 1.1 bouyer MUSB2_REG_EPFIFO(ep->ep_number), data, datalen);
2079 1.1 bouyer }
2080 1.1 bouyer
2081 1.1 bouyer motg_setup_endpoint_tx(xfer);
2082 1.1 bouyer /* Max packet size */
2083 1.1 bouyer UWRITE2(sc, MUSB2_REG_TXMAXP,
2084 1.12.2.6 skrll UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize));
2085 1.1 bouyer /* Data Toggle */
2086 1.1 bouyer val = UREAD1(sc, MUSB2_REG_TXCSRH);
2087 1.1 bouyer val |= MUSB2_MASK_CSRH_TXDT_WREN;
2088 1.1 bouyer if (otgpipe->nexttoggle)
2089 1.1 bouyer val |= MUSB2_MASK_CSRH_TXDT_VAL;
2090 1.1 bouyer else
2091 1.1 bouyer val &= ~MUSB2_MASK_CSRH_TXDT_VAL;
2092 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRH, val);
2093 1.1 bouyer
2094 1.1 bouyer /* start transaction */
2095 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, MUSB2_MASK_CSRL_TXPKTRDY);
2096 1.1 bouyer }
2097 1.1 bouyer
2098 1.1 bouyer static void
2099 1.1 bouyer motg_device_intr_rx(struct motg_softc *sc, int epnumber)
2100 1.1 bouyer {
2101 1.1 bouyer struct motg_hw_ep *ep = &sc->sc_in_ep[epnumber];
2102 1.1 bouyer usbd_xfer_handle xfer = ep->xfer;
2103 1.1 bouyer uint8_t csr;
2104 1.1 bouyer int datalen, max_datalen;
2105 1.1 bouyer char *data;
2106 1.1 bouyer bool got_short;
2107 1.3 bouyer usbd_status new_status = USBD_IN_PROGRESS;
2108 1.1 bouyer
2109 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2110 1.1 bouyer KASSERT(ep->ep_number == epnumber);
2111 1.1 bouyer
2112 1.7 skrll DPRINTFN(MD_BULK,
2113 1.1 bouyer ("motg_device_intr_rx on ep %d\n", epnumber));
2114 1.12.2.2 skrll /* select endpoint */
2115 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, epnumber);
2116 1.1 bouyer
2117 1.1 bouyer /* read out FIFO status */
2118 1.1 bouyer csr = UREAD1(sc, MUSB2_REG_RXCSRL);
2119 1.7 skrll DPRINTFN(MD_BULK,
2120 1.7 skrll ("motg_device_intr_rx phase %d csr 0x%x\n",
2121 1.1 bouyer ep->phase, csr));
2122 1.1 bouyer
2123 1.1 bouyer if ((csr & (MUSB2_MASK_CSRL_RXNAKTO | MUSB2_MASK_CSRL_RXSTALL |
2124 1.1 bouyer MUSB2_MASK_CSRL_RXERROR | MUSB2_MASK_CSRL_RXPKTRDY)) == 0)
2125 1.1 bouyer return;
2126 1.1 bouyer
2127 1.1 bouyer #ifdef DIAGNOSTIC
2128 1.1 bouyer if (ep->phase != DATA_IN)
2129 1.1 bouyer panic("motg_device_intr_rx: bad phase %d", ep->phase);
2130 1.1 bouyer #endif
2131 1.1 bouyer if (csr & MUSB2_MASK_CSRL_RXNAKTO) {
2132 1.1 bouyer csr &= ~MUSB2_MASK_CSRL_RXREQPKT;
2133 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, csr);
2134 1.1 bouyer
2135 1.1 bouyer csr &= ~MUSB2_MASK_CSRL_RXNAKTO;
2136 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, csr);
2137 1.3 bouyer new_status = USBD_TIMEOUT; /* XXX */
2138 1.1 bouyer goto complete;
2139 1.1 bouyer }
2140 1.1 bouyer if (csr & (MUSB2_MASK_CSRL_RXSTALL | MUSB2_MASK_CSRL_RXERROR)) {
2141 1.7 skrll if (csr & MUSB2_MASK_CSRL_RXSTALL)
2142 1.3 bouyer new_status = USBD_STALLED;
2143 1.3 bouyer else
2144 1.3 bouyer new_status = USBD_IOERROR;
2145 1.1 bouyer /* clear status */
2146 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, 0);
2147 1.1 bouyer goto complete;
2148 1.1 bouyer }
2149 1.1 bouyer KASSERT(csr & MUSB2_MASK_CSRL_RXPKTRDY);
2150 1.1 bouyer
2151 1.12.2.6 skrll if (xfer == NULL || xfer->ux_status != USBD_IN_PROGRESS) {
2152 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, 0);
2153 1.1 bouyer goto complete;
2154 1.1 bouyer }
2155 1.1 bouyer
2156 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
2157 1.1 bouyer otgpipe->nexttoggle = otgpipe->nexttoggle ^ 1;
2158 1.1 bouyer
2159 1.1 bouyer datalen = UREAD2(sc, MUSB2_REG_RXCOUNT);
2160 1.7 skrll DPRINTFN(MD_BULK,
2161 1.7 skrll ("motg_device_intr_rx phase %d datalen %d\n",
2162 1.1 bouyer ep->phase, datalen));
2163 1.12.2.6 skrll KASSERT(UE_GET_SIZE(UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize)) > 0);
2164 1.1 bouyer max_datalen = min(
2165 1.12.2.6 skrll UE_GET_SIZE(UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize)),
2166 1.1 bouyer ep->datalen);
2167 1.1 bouyer if (datalen > max_datalen) {
2168 1.3 bouyer new_status = USBD_IOERROR;
2169 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, 0);
2170 1.1 bouyer goto complete;
2171 1.1 bouyer }
2172 1.1 bouyer got_short = (datalen < max_datalen);
2173 1.1 bouyer if (datalen > 0) {
2174 1.1 bouyer KASSERT(ep->phase == DATA_IN);
2175 1.1 bouyer data = ep->data;
2176 1.1 bouyer ep->data += datalen;
2177 1.1 bouyer ep->datalen -= datalen;
2178 1.12.2.6 skrll xfer->ux_actlen += datalen;
2179 1.1 bouyer if (((vaddr_t)data & 0x3) == 0 &&
2180 1.1 bouyer (datalen >> 2) > 0) {
2181 1.7 skrll DPRINTFN(MD_BULK,
2182 1.1 bouyer ("motg_device_intr_rx r4 data %p len %d\n",
2183 1.1 bouyer data, datalen));
2184 1.1 bouyer bus_space_read_multi_4(sc->sc_iot, sc->sc_ioh,
2185 1.1 bouyer MUSB2_REG_EPFIFO(ep->ep_number),
2186 1.1 bouyer (void *)data, datalen >> 2);
2187 1.1 bouyer data += (datalen & ~0x3);
2188 1.1 bouyer datalen -= (datalen & ~0x3);
2189 1.1 bouyer }
2190 1.7 skrll DPRINTFN(MD_BULK,
2191 1.1 bouyer ("motg_device_intr_rx r1 data %p len %d\n",
2192 1.1 bouyer data, datalen));
2193 1.1 bouyer if (datalen) {
2194 1.1 bouyer bus_space_read_multi_1(sc->sc_iot, sc->sc_ioh,
2195 1.1 bouyer MUSB2_REG_EPFIFO(ep->ep_number), data, datalen);
2196 1.1 bouyer }
2197 1.1 bouyer }
2198 1.1 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, 0);
2199 1.1 bouyer KASSERT(ep->phase == DATA_IN);
2200 1.1 bouyer if (got_short || (ep->datalen == 0)) {
2201 1.1 bouyer if (ep->need_short_xfer == 0) {
2202 1.3 bouyer new_status = USBD_NORMAL_COMPLETION;
2203 1.1 bouyer goto complete;
2204 1.1 bouyer }
2205 1.1 bouyer ep->need_short_xfer = 0;
2206 1.1 bouyer }
2207 1.1 bouyer motg_device_data_read(xfer);
2208 1.1 bouyer return;
2209 1.1 bouyer complete:
2210 1.7 skrll DPRINTFN(MD_BULK,
2211 1.1 bouyer ("motg_device_intr_rx xfer %p complete, status %d\n", xfer,
2212 1.12.2.6 skrll (xfer != NULL) ? xfer->ux_status : 0));
2213 1.1 bouyer ep->phase = IDLE;
2214 1.1 bouyer ep->xfer = NULL;
2215 1.12.2.6 skrll if (xfer && xfer->ux_status == USBD_IN_PROGRESS) {
2216 1.3 bouyer KASSERT(new_status != USBD_IN_PROGRESS);
2217 1.12.2.6 skrll xfer->ux_status = new_status;
2218 1.1 bouyer usb_transfer_complete(xfer);
2219 1.3 bouyer }
2220 1.1 bouyer motg_device_data_start1(sc, ep);
2221 1.1 bouyer }
2222 1.1 bouyer
2223 1.1 bouyer static void
2224 1.1 bouyer motg_device_intr_tx(struct motg_softc *sc, int epnumber)
2225 1.1 bouyer {
2226 1.1 bouyer struct motg_hw_ep *ep = &sc->sc_out_ep[epnumber];
2227 1.1 bouyer usbd_xfer_handle xfer = ep->xfer;
2228 1.1 bouyer uint8_t csr;
2229 1.1 bouyer struct motg_pipe *otgpipe;
2230 1.3 bouyer usbd_status new_status = USBD_IN_PROGRESS;
2231 1.1 bouyer
2232 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2233 1.1 bouyer KASSERT(ep->ep_number == epnumber);
2234 1.1 bouyer
2235 1.7 skrll DPRINTFN(MD_BULK,
2236 1.1 bouyer ("motg_device_intr_tx on ep %d\n", epnumber));
2237 1.12.2.2 skrll /* select endpoint */
2238 1.1 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX, epnumber);
2239 1.1 bouyer
2240 1.1 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
2241 1.7 skrll DPRINTFN(MD_BULK,
2242 1.7 skrll ("motg_device_intr_tx phase %d csr 0x%x\n",
2243 1.1 bouyer ep->phase, csr));
2244 1.1 bouyer
2245 1.1 bouyer if (csr & (MUSB2_MASK_CSRL_TXSTALLED|MUSB2_MASK_CSRL_TXERROR)) {
2246 1.1 bouyer /* command not accepted */
2247 1.7 skrll if (csr & MUSB2_MASK_CSRL_TXSTALLED)
2248 1.3 bouyer new_status = USBD_STALLED;
2249 1.3 bouyer else
2250 1.3 bouyer new_status = USBD_IOERROR;
2251 1.1 bouyer /* clear status */
2252 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
2253 1.1 bouyer goto complete;
2254 1.1 bouyer }
2255 1.1 bouyer if (csr & MUSB2_MASK_CSRL_TXNAKTO) {
2256 1.3 bouyer new_status = USBD_TIMEOUT; /* XXX */
2257 1.3 bouyer csr &= ~MUSB2_MASK_CSRL_TXNAKTO;
2258 1.3 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr);
2259 1.1 bouyer /* flush fifo */
2260 1.1 bouyer while (csr & MUSB2_MASK_CSRL_TXFIFONEMPTY) {
2261 1.1 bouyer csr |= MUSB2_MASK_CSRL_TXFFLUSH;
2262 1.3 bouyer csr &= ~MUSB2_MASK_CSRL_TXNAKTO;
2263 1.1 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr);
2264 1.3 bouyer delay(1000);
2265 1.1 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
2266 1.3 bouyer DPRINTFN(MD_BULK, ("TX fifo flush ep %d CSR 0x%x\n",
2267 1.3 bouyer epnumber, csr));
2268 1.1 bouyer }
2269 1.1 bouyer goto complete;
2270 1.1 bouyer }
2271 1.1 bouyer if (csr & (MUSB2_MASK_CSRL_TXFIFONEMPTY|MUSB2_MASK_CSRL_TXPKTRDY)) {
2272 1.1 bouyer /* data still not sent */
2273 1.1 bouyer return;
2274 1.1 bouyer }
2275 1.12.2.6 skrll if (xfer == NULL || xfer->ux_status != USBD_IN_PROGRESS)
2276 1.1 bouyer goto complete;
2277 1.1 bouyer #ifdef DIAGNOSTIC
2278 1.1 bouyer if (ep->phase != DATA_OUT)
2279 1.1 bouyer panic("motg_device_intr_tx: bad phase %d", ep->phase);
2280 1.1 bouyer #endif
2281 1.7 skrll
2282 1.12.2.6 skrll otgpipe = (struct motg_pipe *)xfer->ux_pipe;
2283 1.1 bouyer otgpipe->nexttoggle = otgpipe->nexttoggle ^ 1;
2284 1.1 bouyer
2285 1.1 bouyer if (ep->datalen == 0) {
2286 1.1 bouyer if (ep->need_short_xfer) {
2287 1.1 bouyer ep->need_short_xfer = 0;
2288 1.1 bouyer /* one more data phase */
2289 1.1 bouyer } else {
2290 1.3 bouyer new_status = USBD_NORMAL_COMPLETION;
2291 1.1 bouyer goto complete;
2292 1.1 bouyer }
2293 1.1 bouyer }
2294 1.1 bouyer motg_device_data_write(xfer);
2295 1.1 bouyer return;
2296 1.1 bouyer
2297 1.1 bouyer complete:
2298 1.7 skrll DPRINTFN(MD_BULK,
2299 1.1 bouyer ("motg_device_intr_tx xfer %p complete, status %d\n", xfer,
2300 1.12.2.6 skrll (xfer != NULL) ? xfer->ux_status : 0));
2301 1.1 bouyer #ifdef DIAGNOSTIC
2302 1.12.2.6 skrll if (xfer && xfer->ux_status == USBD_IN_PROGRESS && ep->phase != DATA_OUT)
2303 1.1 bouyer panic("motg_device_intr_tx: bad phase %d", ep->phase);
2304 1.1 bouyer #endif
2305 1.1 bouyer ep->phase = IDLE;
2306 1.1 bouyer ep->xfer = NULL;
2307 1.12.2.6 skrll if (xfer && xfer->ux_status == USBD_IN_PROGRESS) {
2308 1.3 bouyer KASSERT(new_status != USBD_IN_PROGRESS);
2309 1.12.2.6 skrll xfer->ux_status = new_status;
2310 1.1 bouyer usb_transfer_complete(xfer);
2311 1.3 bouyer }
2312 1.1 bouyer motg_device_data_start1(sc, ep);
2313 1.1 bouyer }
2314 1.1 bouyer
2315 1.1 bouyer /* Abort a device control request. */
2316 1.1 bouyer void
2317 1.1 bouyer motg_device_data_abort(usbd_xfer_handle xfer)
2318 1.1 bouyer {
2319 1.1 bouyer #ifdef DIAGNOSTIC
2320 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
2321 1.1 bouyer #endif
2322 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2323 1.1 bouyer
2324 1.3 bouyer DPRINTFN(MD_BULK, ("motg_device_data_abort:\n"));
2325 1.3 bouyer motg_device_xfer_abort(xfer);
2326 1.1 bouyer }
2327 1.1 bouyer
2328 1.1 bouyer /* Close a device control pipe */
2329 1.1 bouyer void
2330 1.1 bouyer motg_device_data_close(usbd_pipe_handle pipe)
2331 1.1 bouyer {
2332 1.12.2.6 skrll struct motg_softc *sc __diagused = pipe->up_dev->ud_bus->ub_hcpriv;
2333 1.1 bouyer struct motg_pipe *otgpipe = (struct motg_pipe *)pipe;
2334 1.1 bouyer struct motg_pipe *otgpipeiter;
2335 1.1 bouyer
2336 1.1 bouyer DPRINTFN(MD_CTRL, ("motg_device_data_close:\n"));
2337 1.1 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2338 1.1 bouyer KASSERT(otgpipe->hw_ep->xfer == NULL ||
2339 1.12.2.6 skrll otgpipe->hw_ep->xfer->ux_pipe != pipe);
2340 1.1 bouyer
2341 1.12.2.6 skrll pipe->up_endpoint->ue_toggle = otgpipe->nexttoggle;
2342 1.1 bouyer SIMPLEQ_FOREACH(otgpipeiter, &otgpipe->hw_ep->ep_pipes, ep_pipe_list) {
2343 1.1 bouyer if (otgpipeiter == otgpipe) {
2344 1.1 bouyer /* remove from list */
2345 1.1 bouyer SIMPLEQ_REMOVE(&otgpipe->hw_ep->ep_pipes, otgpipe,
2346 1.1 bouyer motg_pipe, ep_pipe_list);
2347 1.1 bouyer otgpipe->hw_ep->refcount--;
2348 1.1 bouyer /* we're done */
2349 1.1 bouyer return;
2350 1.1 bouyer }
2351 1.1 bouyer }
2352 1.1 bouyer panic("motg_device_data_close: not found");
2353 1.1 bouyer }
2354 1.1 bouyer
2355 1.1 bouyer void
2356 1.1 bouyer motg_device_data_done(usbd_xfer_handle xfer)
2357 1.1 bouyer {
2358 1.12.2.6 skrll struct motg_pipe *otgpipe __diagused = (struct motg_pipe *)xfer->ux_pipe;
2359 1.1 bouyer DPRINTFN(MD_CTRL, ("motg_device_data_done:\n"));
2360 1.1 bouyer KASSERT(otgpipe->hw_ep->xfer != xfer);
2361 1.1 bouyer }
2362 1.1 bouyer
2363 1.1 bouyer /*
2364 1.1 bouyer * Wait here until controller claims to have an interrupt.
2365 1.1 bouyer * Then call motg_intr and return. Use timeout to avoid waiting
2366 1.1 bouyer * too long.
2367 1.1 bouyer * Only used during boot when interrupts are not enabled yet.
2368 1.1 bouyer */
2369 1.1 bouyer void
2370 1.1 bouyer motg_waitintr(struct motg_softc *sc, usbd_xfer_handle xfer)
2371 1.1 bouyer {
2372 1.12.2.6 skrll int timo = xfer->ux_timeout;
2373 1.1 bouyer
2374 1.1 bouyer mutex_enter(&sc->sc_lock);
2375 1.1 bouyer
2376 1.1 bouyer DPRINTF(("motg_waitintr: timeout = %dms\n", timo));
2377 1.1 bouyer
2378 1.1 bouyer for (; timo >= 0; timo--) {
2379 1.1 bouyer mutex_exit(&sc->sc_lock);
2380 1.1 bouyer usb_delay_ms(&sc->sc_bus, 1);
2381 1.1 bouyer mutex_spin_enter(&sc->sc_intr_lock);
2382 1.1 bouyer motg_poll(&sc->sc_bus);
2383 1.1 bouyer mutex_spin_exit(&sc->sc_intr_lock);
2384 1.1 bouyer mutex_enter(&sc->sc_lock);
2385 1.12.2.6 skrll if (xfer->ux_status != USBD_IN_PROGRESS)
2386 1.1 bouyer goto done;
2387 1.1 bouyer }
2388 1.1 bouyer
2389 1.1 bouyer /* Timeout */
2390 1.1 bouyer DPRINTF(("motg_waitintr: timeout\n"));
2391 1.1 bouyer panic("motg_waitintr: timeout");
2392 1.1 bouyer /* XXX handle timeout ! */
2393 1.1 bouyer
2394 1.1 bouyer done:
2395 1.1 bouyer mutex_exit(&sc->sc_lock);
2396 1.1 bouyer }
2397 1.1 bouyer
2398 1.1 bouyer void
2399 1.1 bouyer motg_device_clear_toggle(usbd_pipe_handle pipe)
2400 1.1 bouyer {
2401 1.1 bouyer struct motg_pipe *otgpipe = (struct motg_pipe *)pipe;
2402 1.1 bouyer otgpipe->nexttoggle = 0;
2403 1.1 bouyer }
2404 1.3 bouyer
2405 1.3 bouyer /* Abort a device control request. */
2406 1.3 bouyer static void
2407 1.3 bouyer motg_device_xfer_abort(usbd_xfer_handle xfer)
2408 1.3 bouyer {
2409 1.3 bouyer int wake;
2410 1.3 bouyer uint8_t csr;
2411 1.12.2.6 skrll struct motg_softc *sc = xfer->ux_pipe->up_dev->ud_bus->ub_hcpriv;
2412 1.12.2.6 skrll struct motg_pipe *otgpipe = (struct motg_pipe *)xfer->ux_pipe;
2413 1.3 bouyer KASSERT(mutex_owned(&sc->sc_lock));
2414 1.3 bouyer
2415 1.3 bouyer DPRINTF(("motg_device_xfer_abort:\n"));
2416 1.12.2.6 skrll if (xfer->ux_hcflags & UXFER_ABORTING) {
2417 1.3 bouyer DPRINTF(("motg_device_xfer_abort: already aborting\n"));
2418 1.12.2.6 skrll xfer->ux_hcflags |= UXFER_ABORTWAIT;
2419 1.12.2.6 skrll while (xfer->ux_hcflags & UXFER_ABORTING)
2420 1.12.2.6 skrll cv_wait(&xfer->ux_hccv, &sc->sc_lock);
2421 1.3 bouyer return;
2422 1.3 bouyer }
2423 1.12.2.6 skrll xfer->ux_hcflags |= UXFER_ABORTING;
2424 1.3 bouyer if (otgpipe->hw_ep->xfer == xfer) {
2425 1.12.2.6 skrll KASSERT(xfer->ux_status == USBD_IN_PROGRESS);
2426 1.3 bouyer otgpipe->hw_ep->xfer = NULL;
2427 1.3 bouyer if (otgpipe->hw_ep->ep_number > 0) {
2428 1.7 skrll /* select endpoint */
2429 1.3 bouyer UWRITE1(sc, MUSB2_REG_EPINDEX,
2430 1.3 bouyer otgpipe->hw_ep->ep_number);
2431 1.3 bouyer if (otgpipe->hw_ep->phase == DATA_OUT) {
2432 1.3 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
2433 1.3 bouyer while (csr & MUSB2_MASK_CSRL_TXFIFONEMPTY) {
2434 1.3 bouyer csr |= MUSB2_MASK_CSRL_TXFFLUSH;
2435 1.3 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, csr);
2436 1.3 bouyer csr = UREAD1(sc, MUSB2_REG_TXCSRL);
2437 1.3 bouyer }
2438 1.3 bouyer UWRITE1(sc, MUSB2_REG_TXCSRL, 0);
2439 1.3 bouyer } else if (otgpipe->hw_ep->phase == DATA_IN) {
2440 1.3 bouyer csr = UREAD1(sc, MUSB2_REG_RXCSRL);
2441 1.3 bouyer while (csr & MUSB2_MASK_CSRL_RXPKTRDY) {
2442 1.3 bouyer csr |= MUSB2_MASK_CSRL_RXFFLUSH;
2443 1.3 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, csr);
2444 1.3 bouyer csr = UREAD1(sc, MUSB2_REG_RXCSRL);
2445 1.3 bouyer }
2446 1.3 bouyer UWRITE1(sc, MUSB2_REG_RXCSRL, 0);
2447 1.3 bouyer }
2448 1.3 bouyer otgpipe->hw_ep->phase = IDLE;
2449 1.3 bouyer }
2450 1.3 bouyer }
2451 1.12.2.6 skrll xfer->ux_status = USBD_CANCELLED; /* make software ignore it */
2452 1.12.2.6 skrll wake = xfer->ux_hcflags & UXFER_ABORTWAIT;
2453 1.12.2.6 skrll xfer->ux_hcflags &= ~(UXFER_ABORTING | UXFER_ABORTWAIT);
2454 1.3 bouyer usb_transfer_complete(xfer);
2455 1.3 bouyer if (wake)
2456 1.12.2.6 skrll cv_broadcast(&xfer->ux_hccv);
2457 1.3 bouyer }
2458