ohci.c revision 1.61 1 1.59 augustss /* $NetBSD: ohci.c,v 1.61 2000/01/16 13:12:06 augustss Exp $ */
2 1.55 augustss /* $FreeBSD: src/sys/dev/usb/ohci.c,v 1.22 1999/11/17 22:33:40 n_hibma Exp $ */
3 1.1 augustss
4 1.1 augustss /*
5 1.1 augustss * Copyright (c) 1998 The NetBSD Foundation, Inc.
6 1.1 augustss * All rights reserved.
7 1.1 augustss *
8 1.11 augustss * This code is derived from software contributed to The NetBSD Foundation
9 1.11 augustss * by Lennart Augustsson (augustss (at) carlstedt.se) at
10 1.11 augustss * Carlstedt Research & Technology.
11 1.1 augustss *
12 1.1 augustss * Redistribution and use in source and binary forms, with or without
13 1.1 augustss * modification, are permitted provided that the following conditions
14 1.1 augustss * are met:
15 1.1 augustss * 1. Redistributions of source code must retain the above copyright
16 1.1 augustss * notice, this list of conditions and the following disclaimer.
17 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 augustss * notice, this list of conditions and the following disclaimer in the
19 1.1 augustss * documentation and/or other materials provided with the distribution.
20 1.1 augustss * 3. All advertising materials mentioning features or use of this software
21 1.1 augustss * must display the following acknowledgement:
22 1.1 augustss * This product includes software developed by the NetBSD
23 1.1 augustss * Foundation, Inc. and its contributors.
24 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
25 1.1 augustss * contributors may be used to endorse or promote products derived
26 1.1 augustss * from this software without specific prior written permission.
27 1.1 augustss *
28 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
29 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
30 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
31 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
32 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
33 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
34 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
35 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
36 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
37 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
38 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
39 1.1 augustss */
40 1.1 augustss
41 1.1 augustss /*
42 1.1 augustss * USB Open Host Controller driver.
43 1.1 augustss *
44 1.30 augustss * OHCI spec: ftp://ftp.compaq.com/pub/supportinformation/papers/hcir1_0a.exe
45 1.30 augustss * USB spec: http://www.usb.org/developers/data/usb11.pdf
46 1.1 augustss */
47 1.1 augustss
48 1.1 augustss #include <sys/param.h>
49 1.1 augustss #include <sys/systm.h>
50 1.1 augustss #include <sys/malloc.h>
51 1.36 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
52 1.55 augustss #include <sys/kernel.h>
53 1.1 augustss #include <sys/device.h>
54 1.55 augustss #include <sys/select.h>
55 1.15 augustss #elif defined(__FreeBSD__)
56 1.15 augustss #include <sys/module.h>
57 1.15 augustss #include <sys/bus.h>
58 1.52 augustss #include <machine/bus_pio.h>
59 1.52 augustss #include <machine/bus_memio.h>
60 1.55 augustss #if defined(DIAGNOSTIC) && defined(__i386__) && defined(__FreeBSD__)
61 1.55 augustss #include <machine/cpu.h>
62 1.55 augustss #endif
63 1.15 augustss #endif
64 1.1 augustss #include <sys/proc.h>
65 1.1 augustss #include <sys/queue.h>
66 1.1 augustss
67 1.4 augustss #include <machine/bus.h>
68 1.16 augustss #include <machine/endian.h>
69 1.4 augustss
70 1.1 augustss #include <dev/usb/usb.h>
71 1.1 augustss #include <dev/usb/usbdi.h>
72 1.1 augustss #include <dev/usb/usbdivar.h>
73 1.38 augustss #include <dev/usb/usb_mem.h>
74 1.1 augustss #include <dev/usb/usb_quirks.h>
75 1.1 augustss
76 1.1 augustss #include <dev/usb/ohcireg.h>
77 1.1 augustss #include <dev/usb/ohcivar.h>
78 1.1 augustss
79 1.15 augustss #if defined(__FreeBSD__)
80 1.15 augustss #include <machine/clock.h>
81 1.55 augustss
82 1.15 augustss #define delay(d) DELAY(d)
83 1.15 augustss #endif
84 1.1 augustss
85 1.36 augustss #if defined(__OpenBSD__)
86 1.36 augustss struct cfdriver ohci_cd = {
87 1.36 augustss NULL, "ohci", DV_DULL
88 1.36 augustss };
89 1.36 augustss #endif
90 1.36 augustss
91 1.52 augustss #ifdef OHCI_DEBUG
92 1.52 augustss #define DPRINTF(x) if (ohcidebug) logprintf x
93 1.52 augustss #define DPRINTFN(n,x) if (ohcidebug>(n)) logprintf x
94 1.52 augustss int ohcidebug = 0;
95 1.52 augustss #else
96 1.52 augustss #define DPRINTF(x)
97 1.52 augustss #define DPRINTFN(n,x)
98 1.52 augustss #endif
99 1.52 augustss
100 1.16 augustss /*
101 1.16 augustss * The OHCI controller is little endian, so on big endian machines
102 1.16 augustss * the data strored in memory needs to be swapped.
103 1.16 augustss */
104 1.16 augustss #if BYTE_ORDER == BIG_ENDIAN
105 1.16 augustss #define LE(x) (bswap32(x))
106 1.16 augustss #else
107 1.16 augustss #define LE(x) (x)
108 1.16 augustss #endif
109 1.16 augustss
110 1.1 augustss struct ohci_pipe;
111 1.1 augustss
112 1.53 augustss static ohci_soft_ed_t *ohci_alloc_sed __P((ohci_softc_t *));
113 1.53 augustss static void ohci_free_sed __P((ohci_softc_t *, ohci_soft_ed_t *));
114 1.1 augustss
115 1.53 augustss static ohci_soft_td_t *ohci_alloc_std __P((ohci_softc_t *));
116 1.53 augustss static void ohci_free_std __P((ohci_softc_t *, ohci_soft_td_t *));
117 1.1 augustss
118 1.60 augustss static ohci_soft_itd_t *ohci_alloc_sitd __P((ohci_softc_t *));
119 1.60 augustss static void ohci_free_sitd __P((ohci_softc_t *,ohci_soft_itd_t *));
120 1.60 augustss
121 1.53 augustss #if 0
122 1.53 augustss static void ohci_free_std_chain __P((ohci_softc_t *,
123 1.53 augustss ohci_soft_td_t *, ohci_soft_td_t *));
124 1.53 augustss #endif
125 1.53 augustss static usbd_status ohci_alloc_std_chain __P((struct ohci_pipe *,
126 1.61 augustss ohci_softc_t *, int, int, u_int16_t, usb_dma_t *,
127 1.53 augustss ohci_soft_td_t *, ohci_soft_td_t **));
128 1.53 augustss
129 1.59 augustss static void ohci_shutdown __P((void *v));
130 1.53 augustss static void ohci_power __P((int, void *));
131 1.53 augustss static usbd_status ohci_open __P((usbd_pipe_handle));
132 1.53 augustss static void ohci_poll __P((struct usbd_bus *));
133 1.53 augustss static void ohci_waitintr __P((ohci_softc_t *,
134 1.53 augustss usbd_xfer_handle));
135 1.53 augustss static void ohci_rhsc __P((ohci_softc_t *, usbd_xfer_handle));
136 1.53 augustss static void ohci_process_done __P((ohci_softc_t *,
137 1.53 augustss ohci_physaddr_t));
138 1.53 augustss
139 1.53 augustss static usbd_status ohci_device_request __P((usbd_xfer_handle xfer));
140 1.53 augustss static void ohci_add_ed __P((ohci_soft_ed_t *, ohci_soft_ed_t *));
141 1.53 augustss static void ohci_rem_ed __P((ohci_soft_ed_t *, ohci_soft_ed_t *));
142 1.53 augustss static void ohci_hash_add_td __P((ohci_softc_t *,
143 1.53 augustss ohci_soft_td_t *));
144 1.53 augustss static void ohci_hash_rem_td __P((ohci_softc_t *,
145 1.53 augustss ohci_soft_td_t *));
146 1.53 augustss static ohci_soft_td_t *ohci_hash_find_td __P((ohci_softc_t *,
147 1.53 augustss ohci_physaddr_t));
148 1.53 augustss
149 1.60 augustss static usbd_status ohci_setup_isoc __P((usbd_pipe_handle pipe));
150 1.60 augustss static void ohci_device_isoc_enter __P((usbd_xfer_handle));
151 1.60 augustss
152 1.53 augustss static usbd_status ohci_allocm __P((struct usbd_bus *, usb_dma_t *,
153 1.53 augustss u_int32_t));
154 1.53 augustss static void ohci_freem __P((struct usbd_bus *, usb_dma_t *));
155 1.53 augustss
156 1.53 augustss static usbd_status ohci_root_ctrl_transfer __P((usbd_xfer_handle));
157 1.53 augustss static usbd_status ohci_root_ctrl_start __P((usbd_xfer_handle));
158 1.53 augustss static void ohci_root_ctrl_abort __P((usbd_xfer_handle));
159 1.53 augustss static void ohci_root_ctrl_close __P((usbd_pipe_handle));
160 1.53 augustss
161 1.53 augustss static usbd_status ohci_root_intr_transfer __P((usbd_xfer_handle));
162 1.53 augustss static usbd_status ohci_root_intr_start __P((usbd_xfer_handle));
163 1.53 augustss static void ohci_root_intr_abort __P((usbd_xfer_handle));
164 1.53 augustss static void ohci_root_intr_close __P((usbd_pipe_handle));
165 1.53 augustss static void ohci_root_intr_done __P((usbd_xfer_handle));
166 1.53 augustss
167 1.53 augustss static usbd_status ohci_device_ctrl_transfer __P((usbd_xfer_handle));
168 1.53 augustss static usbd_status ohci_device_ctrl_start __P((usbd_xfer_handle));
169 1.53 augustss static void ohci_device_ctrl_abort __P((usbd_xfer_handle));
170 1.53 augustss static void ohci_device_ctrl_close __P((usbd_pipe_handle));
171 1.53 augustss static void ohci_device_ctrl_done __P((usbd_xfer_handle));
172 1.53 augustss
173 1.53 augustss static usbd_status ohci_device_bulk_transfer __P((usbd_xfer_handle));
174 1.53 augustss static usbd_status ohci_device_bulk_start __P((usbd_xfer_handle));
175 1.53 augustss static void ohci_device_bulk_abort __P((usbd_xfer_handle));
176 1.53 augustss static void ohci_device_bulk_close __P((usbd_pipe_handle));
177 1.53 augustss static void ohci_device_bulk_done __P((usbd_xfer_handle));
178 1.53 augustss
179 1.53 augustss static usbd_status ohci_device_intr_transfer __P((usbd_xfer_handle));
180 1.53 augustss static usbd_status ohci_device_intr_start __P((usbd_xfer_handle));
181 1.53 augustss static void ohci_device_intr_abort __P((usbd_xfer_handle));
182 1.53 augustss static void ohci_device_intr_close __P((usbd_pipe_handle));
183 1.53 augustss static void ohci_device_intr_done __P((usbd_xfer_handle));
184 1.53 augustss
185 1.53 augustss static usbd_status ohci_device_isoc_transfer __P((usbd_xfer_handle));
186 1.53 augustss static usbd_status ohci_device_isoc_start __P((usbd_xfer_handle));
187 1.53 augustss static void ohci_device_isoc_abort __P((usbd_xfer_handle));
188 1.53 augustss static void ohci_device_isoc_close __P((usbd_pipe_handle));
189 1.53 augustss static void ohci_device_isoc_done __P((usbd_xfer_handle));
190 1.53 augustss
191 1.53 augustss static usbd_status ohci_device_setintr __P((ohci_softc_t *sc,
192 1.53 augustss struct ohci_pipe *pipe, int ival));
193 1.53 augustss
194 1.53 augustss static int ohci_str __P((usb_string_descriptor_t *, int, char *));
195 1.53 augustss
196 1.53 augustss static void ohci_timeout __P((void *));
197 1.53 augustss static void ohci_rhsc_able __P((ohci_softc_t *, int));
198 1.34 augustss
199 1.53 augustss static void ohci_close_pipe __P((usbd_pipe_handle pipe,
200 1.53 augustss ohci_soft_ed_t *head));
201 1.54 augustss static void ohci_abort_xfer __P((usbd_xfer_handle xfer,
202 1.53 augustss usbd_status status));
203 1.54 augustss static void ohci_abort_xfer_end __P((void *));
204 1.53 augustss
205 1.53 augustss static void ohci_device_clear_toggle __P((usbd_pipe_handle pipe));
206 1.53 augustss static void ohci_noop __P((usbd_pipe_handle pipe));
207 1.37 augustss
208 1.52 augustss #ifdef OHCI_DEBUG
209 1.53 augustss static void ohci_dumpregs __P((ohci_softc_t *));
210 1.53 augustss static void ohci_dump_tds __P((ohci_soft_td_t *));
211 1.53 augustss static void ohci_dump_td __P((ohci_soft_td_t *));
212 1.53 augustss static void ohci_dump_ed __P((ohci_soft_ed_t *));
213 1.1 augustss #endif
214 1.1 augustss
215 1.1 augustss #define OWRITE4(sc, r, x) bus_space_write_4((sc)->iot, (sc)->ioh, (r), (x))
216 1.1 augustss #define OREAD4(sc, r) bus_space_read_4((sc)->iot, (sc)->ioh, (r))
217 1.1 augustss #define OREAD2(sc, r) bus_space_read_2((sc)->iot, (sc)->ioh, (r))
218 1.1 augustss
219 1.1 augustss /* Reverse the bits in a value 0 .. 31 */
220 1.1 augustss static u_int8_t revbits[OHCI_NO_INTRS] =
221 1.1 augustss { 0x00, 0x10, 0x08, 0x18, 0x04, 0x14, 0x0c, 0x1c,
222 1.1 augustss 0x02, 0x12, 0x0a, 0x1a, 0x06, 0x16, 0x0e, 0x1e,
223 1.1 augustss 0x01, 0x11, 0x09, 0x19, 0x05, 0x15, 0x0d, 0x1d,
224 1.1 augustss 0x03, 0x13, 0x0b, 0x1b, 0x07, 0x17, 0x0f, 0x1f };
225 1.1 augustss
226 1.1 augustss struct ohci_pipe {
227 1.1 augustss struct usbd_pipe pipe;
228 1.1 augustss ohci_soft_ed_t *sed;
229 1.60 augustss union {
230 1.60 augustss ohci_soft_td_t *td;
231 1.60 augustss ohci_soft_itd_t *itd;
232 1.60 augustss } tail;
233 1.1 augustss /* Info needed for different pipe kinds. */
234 1.1 augustss union {
235 1.1 augustss /* Control pipe */
236 1.1 augustss struct {
237 1.4 augustss usb_dma_t reqdma;
238 1.1 augustss u_int length;
239 1.48 augustss ohci_soft_td_t *setup, *data, *stat;
240 1.1 augustss } ctl;
241 1.1 augustss /* Interrupt pipe */
242 1.1 augustss struct {
243 1.1 augustss int nslots;
244 1.1 augustss int pos;
245 1.1 augustss } intr;
246 1.3 augustss /* Bulk pipe */
247 1.3 augustss struct {
248 1.3 augustss u_int length;
249 1.32 augustss int isread;
250 1.3 augustss } bulk;
251 1.43 augustss /* Iso pipe */
252 1.43 augustss struct iso {
253 1.60 augustss int next, inuse;
254 1.43 augustss } iso;
255 1.1 augustss } u;
256 1.1 augustss };
257 1.1 augustss
258 1.1 augustss #define OHCI_INTR_ENDPT 1
259 1.1 augustss
260 1.53 augustss static struct usbd_bus_methods ohci_bus_methods = {
261 1.42 augustss ohci_open,
262 1.42 augustss ohci_poll,
263 1.42 augustss ohci_allocm,
264 1.42 augustss ohci_freem,
265 1.42 augustss };
266 1.42 augustss
267 1.53 augustss static struct usbd_pipe_methods ohci_root_ctrl_methods = {
268 1.1 augustss ohci_root_ctrl_transfer,
269 1.17 augustss ohci_root_ctrl_start,
270 1.1 augustss ohci_root_ctrl_abort,
271 1.1 augustss ohci_root_ctrl_close,
272 1.37 augustss ohci_noop,
273 1.7 augustss 0,
274 1.1 augustss };
275 1.1 augustss
276 1.53 augustss static struct usbd_pipe_methods ohci_root_intr_methods = {
277 1.1 augustss ohci_root_intr_transfer,
278 1.17 augustss ohci_root_intr_start,
279 1.1 augustss ohci_root_intr_abort,
280 1.1 augustss ohci_root_intr_close,
281 1.37 augustss ohci_noop,
282 1.38 augustss ohci_root_intr_done,
283 1.1 augustss };
284 1.1 augustss
285 1.53 augustss static struct usbd_pipe_methods ohci_device_ctrl_methods = {
286 1.1 augustss ohci_device_ctrl_transfer,
287 1.17 augustss ohci_device_ctrl_start,
288 1.1 augustss ohci_device_ctrl_abort,
289 1.1 augustss ohci_device_ctrl_close,
290 1.37 augustss ohci_noop,
291 1.38 augustss ohci_device_ctrl_done,
292 1.1 augustss };
293 1.1 augustss
294 1.53 augustss static struct usbd_pipe_methods ohci_device_intr_methods = {
295 1.1 augustss ohci_device_intr_transfer,
296 1.17 augustss ohci_device_intr_start,
297 1.1 augustss ohci_device_intr_abort,
298 1.1 augustss ohci_device_intr_close,
299 1.37 augustss ohci_device_clear_toggle,
300 1.38 augustss ohci_device_intr_done,
301 1.1 augustss };
302 1.1 augustss
303 1.53 augustss static struct usbd_pipe_methods ohci_device_bulk_methods = {
304 1.3 augustss ohci_device_bulk_transfer,
305 1.17 augustss ohci_device_bulk_start,
306 1.3 augustss ohci_device_bulk_abort,
307 1.3 augustss ohci_device_bulk_close,
308 1.37 augustss ohci_device_clear_toggle,
309 1.38 augustss ohci_device_bulk_done,
310 1.3 augustss };
311 1.3 augustss
312 1.53 augustss static struct usbd_pipe_methods ohci_device_isoc_methods = {
313 1.43 augustss ohci_device_isoc_transfer,
314 1.43 augustss ohci_device_isoc_start,
315 1.43 augustss ohci_device_isoc_abort,
316 1.43 augustss ohci_device_isoc_close,
317 1.43 augustss ohci_noop,
318 1.43 augustss ohci_device_isoc_done,
319 1.43 augustss };
320 1.43 augustss
321 1.55 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
322 1.47 augustss int
323 1.47 augustss ohci_activate(self, act)
324 1.47 augustss device_ptr_t self;
325 1.47 augustss enum devact act;
326 1.47 augustss {
327 1.49 augustss struct ohci_softc *sc = (struct ohci_softc *)self;
328 1.47 augustss int rv = 0;
329 1.47 augustss
330 1.47 augustss switch (act) {
331 1.47 augustss case DVACT_ACTIVATE:
332 1.47 augustss return (EOPNOTSUPP);
333 1.47 augustss break;
334 1.47 augustss
335 1.47 augustss case DVACT_DEACTIVATE:
336 1.49 augustss if (sc->sc_child != NULL)
337 1.49 augustss rv = config_deactivate(sc->sc_child);
338 1.47 augustss break;
339 1.47 augustss }
340 1.47 augustss return (rv);
341 1.47 augustss }
342 1.47 augustss
343 1.47 augustss int
344 1.50 augustss ohci_detach(sc, flags)
345 1.50 augustss struct ohci_softc *sc;
346 1.47 augustss int flags;
347 1.47 augustss {
348 1.47 augustss int rv = 0;
349 1.47 augustss
350 1.47 augustss if (sc->sc_child != NULL)
351 1.47 augustss rv = config_detach(sc->sc_child, flags);
352 1.47 augustss
353 1.47 augustss if (rv != 0)
354 1.47 augustss return (rv);
355 1.47 augustss
356 1.47 augustss powerhook_disestablish(sc->sc_powerhook);
357 1.59 augustss shutdownhook_disestablish(sc->sc_shutdownhook);
358 1.59 augustss
359 1.47 augustss /* free data structures XXX */
360 1.47 augustss
361 1.47 augustss return (rv);
362 1.47 augustss }
363 1.55 augustss #endif
364 1.47 augustss
365 1.1 augustss ohci_soft_ed_t *
366 1.1 augustss ohci_alloc_sed(sc)
367 1.1 augustss ohci_softc_t *sc;
368 1.1 augustss {
369 1.1 augustss ohci_soft_ed_t *sed;
370 1.53 augustss usbd_status err;
371 1.1 augustss int i, offs;
372 1.4 augustss usb_dma_t dma;
373 1.1 augustss
374 1.53 augustss if (sc->sc_freeeds == NULL) {
375 1.1 augustss DPRINTFN(2, ("ohci_alloc_sed: allocating chunk\n"));
376 1.53 augustss err = usb_allocmem(&sc->sc_bus, OHCI_SED_SIZE * OHCI_SED_CHUNK,
377 1.53 augustss OHCI_ED_ALIGN, &dma);
378 1.53 augustss if (err)
379 1.39 augustss return (0);
380 1.39 augustss for(i = 0; i < OHCI_SED_CHUNK; i++) {
381 1.39 augustss offs = i * OHCI_SED_SIZE;
382 1.39 augustss sed = (ohci_soft_ed_t *)((char *)KERNADDR(&dma) +offs);
383 1.1 augustss sed->physaddr = DMAADDR(&dma) + offs;
384 1.1 augustss sed->next = sc->sc_freeeds;
385 1.1 augustss sc->sc_freeeds = sed;
386 1.1 augustss }
387 1.1 augustss }
388 1.1 augustss sed = sc->sc_freeeds;
389 1.1 augustss sc->sc_freeeds = sed->next;
390 1.39 augustss memset(&sed->ed, 0, sizeof(ohci_ed_t));
391 1.1 augustss sed->next = 0;
392 1.39 augustss return (sed);
393 1.1 augustss }
394 1.1 augustss
395 1.1 augustss void
396 1.1 augustss ohci_free_sed(sc, sed)
397 1.1 augustss ohci_softc_t *sc;
398 1.1 augustss ohci_soft_ed_t *sed;
399 1.1 augustss {
400 1.1 augustss sed->next = sc->sc_freeeds;
401 1.1 augustss sc->sc_freeeds = sed;
402 1.1 augustss }
403 1.1 augustss
404 1.1 augustss ohci_soft_td_t *
405 1.1 augustss ohci_alloc_std(sc)
406 1.1 augustss ohci_softc_t *sc;
407 1.1 augustss {
408 1.1 augustss ohci_soft_td_t *std;
409 1.53 augustss usbd_status err;
410 1.1 augustss int i, offs;
411 1.4 augustss usb_dma_t dma;
412 1.1 augustss
413 1.53 augustss if (sc->sc_freetds == NULL) {
414 1.1 augustss DPRINTFN(2, ("ohci_alloc_std: allocating chunk\n"));
415 1.53 augustss err = usb_allocmem(&sc->sc_bus, OHCI_STD_SIZE * OHCI_STD_CHUNK,
416 1.53 augustss OHCI_TD_ALIGN, &dma);
417 1.53 augustss if (err)
418 1.39 augustss return (0);
419 1.39 augustss for(i = 0; i < OHCI_STD_CHUNK; i++) {
420 1.39 augustss offs = i * OHCI_STD_SIZE;
421 1.39 augustss std = (ohci_soft_td_t *)((char *)KERNADDR(&dma) +offs);
422 1.1 augustss std->physaddr = DMAADDR(&dma) + offs;
423 1.1 augustss std->nexttd = sc->sc_freetds;
424 1.1 augustss sc->sc_freetds = std;
425 1.1 augustss }
426 1.1 augustss }
427 1.1 augustss std = sc->sc_freetds;
428 1.1 augustss sc->sc_freetds = std->nexttd;
429 1.39 augustss memset(&std->td, 0, sizeof(ohci_td_t));
430 1.1 augustss std->nexttd = 0;
431 1.1 augustss return (std);
432 1.1 augustss }
433 1.1 augustss
434 1.1 augustss void
435 1.1 augustss ohci_free_std(sc, std)
436 1.1 augustss ohci_softc_t *sc;
437 1.1 augustss ohci_soft_td_t *std;
438 1.1 augustss {
439 1.1 augustss std->nexttd = sc->sc_freetds;
440 1.1 augustss sc->sc_freetds = std;
441 1.1 augustss }
442 1.1 augustss
443 1.1 augustss usbd_status
444 1.61 augustss ohci_alloc_std_chain(opipe, sc, len, rd, flags, dma, sp, ep)
445 1.61 augustss struct ohci_pipe *opipe;
446 1.48 augustss ohci_softc_t *sc;
447 1.61 augustss int len, rd;
448 1.61 augustss u_int16_t flags;
449 1.48 augustss usb_dma_t *dma;
450 1.48 augustss ohci_soft_td_t *sp, **ep;
451 1.48 augustss {
452 1.48 augustss ohci_soft_td_t *next, *cur;
453 1.48 augustss ohci_physaddr_t dataphys, dataphysend;
454 1.61 augustss u_int32_t intr, tdflags;
455 1.48 augustss int curlen;
456 1.48 augustss
457 1.55 augustss DPRINTFN(len < 4096,("ohci_alloc_std_chain: start len=%d\n", len));
458 1.48 augustss cur = sp;
459 1.48 augustss dataphys = DMAADDR(dma);
460 1.48 augustss dataphysend = OHCI_PAGE(dataphys + len - 1);
461 1.61 augustss tdflags =
462 1.61 augustss (rd ? OHCI_TD_IN : OHCI_TD_OUT) |
463 1.61 augustss OHCI_TD_NOCC | OHCI_TD_TOGGLE_CARRY |
464 1.61 augustss (flags & USBD_SHORT_XFER_OK ? OHCI_TD_R : 0);
465 1.61 augustss
466 1.48 augustss for (;;) {
467 1.48 augustss next = ohci_alloc_std(sc);
468 1.61 augustss if (next == 0)
469 1.61 augustss goto nomem;
470 1.48 augustss
471 1.48 augustss /* The OHCI hardware can handle at most one page crossing. */
472 1.48 augustss if (OHCI_PAGE(dataphys) == dataphysend ||
473 1.48 augustss OHCI_PAGE(dataphys) + OHCI_PAGE_SIZE == dataphysend) {
474 1.48 augustss /* we can handle it in this TD */
475 1.48 augustss curlen = len;
476 1.48 augustss } else {
477 1.48 augustss /* must use multiple TDs, fill as much as possible. */
478 1.48 augustss curlen = 2 * OHCI_PAGE_SIZE -
479 1.48 augustss (dataphys & (OHCI_PAGE_SIZE-1));
480 1.48 augustss }
481 1.48 augustss DPRINTFN(4,("ohci_alloc_std_chain: dataphys=0x%08x "
482 1.48 augustss "dataphysend=0x%08x len=%d curlen=%d\n",
483 1.48 augustss dataphys, dataphysend,
484 1.48 augustss len, curlen));
485 1.48 augustss len -= curlen;
486 1.48 augustss
487 1.48 augustss intr = len == 0 ? OHCI_TD_SET_DI(1) : OHCI_TD_NOINTR;
488 1.61 augustss cur->td.td_flags = LE(tdflags | intr);
489 1.48 augustss cur->td.td_cbp = LE(dataphys);
490 1.48 augustss cur->nexttd = next;
491 1.48 augustss cur->td.td_nexttd = LE(next->physaddr);
492 1.48 augustss cur->td.td_be = LE(dataphys + curlen - 1);
493 1.48 augustss cur->len = curlen;
494 1.48 augustss cur->flags = OHCI_ADD_LEN;
495 1.48 augustss DPRINTFN(10,("ohci_alloc_std_chain: cbp=0x%08x be=0x%08x\n",
496 1.48 augustss dataphys, dataphys + curlen - 1));
497 1.48 augustss if (len == 0)
498 1.48 augustss break;
499 1.48 augustss DPRINTFN(10,("ohci_alloc_std_chain: extend chain\n"));
500 1.48 augustss dataphys += curlen;
501 1.48 augustss cur = next;
502 1.48 augustss }
503 1.61 augustss if ((flags & USBD_FORCE_SHORT_XFER) &&
504 1.61 augustss len % UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize) == 0) {
505 1.61 augustss /* Force a 0 length transfer at the end. */
506 1.61 augustss next = ohci_alloc_std(sc);
507 1.61 augustss if (next == 0)
508 1.61 augustss goto nomem;
509 1.61 augustss
510 1.61 augustss cur->td.td_flags = LE(tdflags | OHCI_TD_SET_DI(1));
511 1.61 augustss cur->td.td_cbp = 0; /* indicate 0 length packet */
512 1.61 augustss cur->nexttd = next;
513 1.61 augustss cur->td.td_nexttd = LE(next->physaddr);
514 1.61 augustss cur->td.td_be = LE(dataphys - 1);
515 1.61 augustss cur->len = 0;
516 1.61 augustss cur->flags = 0;
517 1.61 augustss cur = next;
518 1.61 augustss DPRINTFN(2,("ohci_alloc_std_chain: add 0 xfer\n"));
519 1.61 augustss }
520 1.48 augustss cur->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
521 1.48 augustss *ep = next;
522 1.48 augustss
523 1.48 augustss return (USBD_NORMAL_COMPLETION);
524 1.61 augustss
525 1.61 augustss nomem:
526 1.61 augustss /* XXX free chain */
527 1.61 augustss return (USBD_NOMEM);
528 1.48 augustss }
529 1.48 augustss
530 1.53 augustss #if 0
531 1.53 augustss static void
532 1.48 augustss ohci_free_std_chain(sc, std, stdend)
533 1.48 augustss ohci_softc_t *sc;
534 1.48 augustss ohci_soft_td_t *std;
535 1.48 augustss ohci_soft_td_t *stdend;
536 1.48 augustss {
537 1.48 augustss ohci_soft_td_t *p;
538 1.48 augustss
539 1.48 augustss for (; std != stdend; std = p) {
540 1.48 augustss p = std->nexttd;
541 1.48 augustss ohci_free_std(sc, std);
542 1.48 augustss }
543 1.48 augustss }
544 1.53 augustss #endif
545 1.48 augustss
546 1.60 augustss ohci_soft_itd_t *
547 1.60 augustss ohci_alloc_sitd(sc)
548 1.60 augustss ohci_softc_t *sc;
549 1.60 augustss {
550 1.60 augustss ohci_soft_itd_t *sitd;
551 1.60 augustss usbd_status err;
552 1.60 augustss int i, offs;
553 1.60 augustss usb_dma_t dma;
554 1.60 augustss
555 1.60 augustss if (sc->sc_freeitds == NULL) {
556 1.60 augustss DPRINTFN(2, ("ohci_alloc_sitd: allocating chunk\n"));
557 1.60 augustss err = usb_allocmem(&sc->sc_bus, OHCI_STD_SIZE * OHCI_STD_CHUNK,
558 1.60 augustss OHCI_TD_ALIGN, &dma);
559 1.60 augustss if (err)
560 1.60 augustss return (0);
561 1.60 augustss for(i = 0; i < OHCI_STD_CHUNK; i++) {
562 1.60 augustss offs = i * OHCI_STD_SIZE;
563 1.60 augustss sitd = (ohci_soft_itd_t *)((char*)KERNADDR(&dma)+offs);
564 1.60 augustss sitd->physaddr = DMAADDR(&dma) + offs;
565 1.60 augustss sitd->nextitd = sc->sc_freeitds;
566 1.60 augustss sc->sc_freeitds = sitd;
567 1.60 augustss }
568 1.60 augustss }
569 1.60 augustss sitd = sc->sc_freeitds;
570 1.60 augustss sc->sc_freeitds = sitd->nextitd;
571 1.60 augustss memset(&sitd->itd, 0, sizeof(ohci_itd_t));
572 1.60 augustss sitd->nextitd = 0;
573 1.60 augustss return (sitd);
574 1.60 augustss }
575 1.60 augustss
576 1.60 augustss void
577 1.60 augustss ohci_free_sitd(sc, sitd)
578 1.60 augustss ohci_softc_t *sc;
579 1.60 augustss ohci_soft_itd_t *sitd;
580 1.60 augustss {
581 1.60 augustss sitd->nextitd = sc->sc_freeitds;
582 1.60 augustss sc->sc_freeitds = sitd;
583 1.60 augustss }
584 1.60 augustss
585 1.48 augustss usbd_status
586 1.1 augustss ohci_init(sc)
587 1.1 augustss ohci_softc_t *sc;
588 1.1 augustss {
589 1.1 augustss ohci_soft_ed_t *sed, *psed;
590 1.53 augustss usbd_status err;
591 1.1 augustss int i;
592 1.60 augustss u_int32_t s, ctl, ival, hcr, fm, per, rev;
593 1.16 augustss
594 1.1 augustss DPRINTF(("ohci_init: start\n"));
595 1.36 augustss #if defined(__OpenBSD__)
596 1.55 augustss printf(",");
597 1.36 augustss #else
598 1.55 augustss printf("%s:", USBDEVNAME(sc->sc_bus.bdev));
599 1.36 augustss #endif
600 1.56 augustss rev = OREAD4(sc, OHCI_REVISION);
601 1.55 augustss printf(" OHCI version %d.%d%s\n", OHCI_REV_HI(rev), OHCI_REV_LO(rev),
602 1.1 augustss OHCI_REV_LEGACY(rev) ? ", legacy support" : "");
603 1.55 augustss
604 1.1 augustss if (OHCI_REV_HI(rev) != 1 || OHCI_REV_LO(rev) != 0) {
605 1.1 augustss printf("%s: unsupported OHCI revision\n",
606 1.15 augustss USBDEVNAME(sc->sc_bus.bdev));
607 1.56 augustss sc->sc_bus.usbrev = USBREV_UNKNOWN;
608 1.1 augustss return (USBD_INVAL);
609 1.1 augustss }
610 1.56 augustss sc->sc_bus.usbrev = USBREV_1_0;
611 1.1 augustss
612 1.1 augustss for (i = 0; i < OHCI_HASH_SIZE; i++)
613 1.1 augustss LIST_INIT(&sc->sc_hash_tds[i]);
614 1.1 augustss
615 1.1 augustss /* Allocate the HCCA area. */
616 1.53 augustss err = usb_allocmem(&sc->sc_bus, OHCI_HCCA_SIZE,
617 1.4 augustss OHCI_HCCA_ALIGN, &sc->sc_hccadma);
618 1.53 augustss if (err)
619 1.53 augustss return (err);
620 1.1 augustss sc->sc_hcca = (struct ohci_hcca *)KERNADDR(&sc->sc_hccadma);
621 1.1 augustss memset(sc->sc_hcca, 0, OHCI_HCCA_SIZE);
622 1.1 augustss
623 1.1 augustss sc->sc_eintrs = OHCI_NORMAL_INTRS;
624 1.1 augustss
625 1.60 augustss /* Allocate dummy ED that starts the control list. */
626 1.1 augustss sc->sc_ctrl_head = ohci_alloc_sed(sc);
627 1.53 augustss if (sc->sc_ctrl_head == NULL) {
628 1.53 augustss err = USBD_NOMEM;
629 1.1 augustss goto bad1;
630 1.1 augustss }
631 1.39 augustss sc->sc_ctrl_head->ed.ed_flags |= LE(OHCI_ED_SKIP);
632 1.34 augustss
633 1.60 augustss /* Allocate dummy ED that starts the bulk list. */
634 1.1 augustss sc->sc_bulk_head = ohci_alloc_sed(sc);
635 1.53 augustss if (sc->sc_bulk_head == NULL) {
636 1.53 augustss err = USBD_NOMEM;
637 1.1 augustss goto bad2;
638 1.1 augustss }
639 1.39 augustss sc->sc_bulk_head->ed.ed_flags |= LE(OHCI_ED_SKIP);
640 1.1 augustss
641 1.60 augustss /* Allocate dummy ED that starts the isochronous list. */
642 1.60 augustss sc->sc_isoc_head = ohci_alloc_sed(sc);
643 1.60 augustss if (sc->sc_isoc_head == NULL) {
644 1.60 augustss err = USBD_NOMEM;
645 1.60 augustss goto bad3;
646 1.60 augustss }
647 1.60 augustss sc->sc_isoc_head->ed.ed_flags |= LE(OHCI_ED_SKIP);
648 1.60 augustss
649 1.1 augustss /* Allocate all the dummy EDs that make up the interrupt tree. */
650 1.1 augustss for (i = 0; i < OHCI_NO_EDS; i++) {
651 1.1 augustss sed = ohci_alloc_sed(sc);
652 1.53 augustss if (sed == NULL) {
653 1.1 augustss while (--i >= 0)
654 1.1 augustss ohci_free_sed(sc, sc->sc_eds[i]);
655 1.53 augustss err = USBD_NOMEM;
656 1.60 augustss goto bad4;
657 1.1 augustss }
658 1.1 augustss /* All ED fields are set to 0. */
659 1.1 augustss sc->sc_eds[i] = sed;
660 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
661 1.60 augustss if (i != 0)
662 1.1 augustss psed = sc->sc_eds[(i-1) / 2];
663 1.60 augustss else
664 1.60 augustss psed= sc->sc_isoc_head;
665 1.60 augustss sed->next = psed;
666 1.60 augustss sed->ed.ed_nexted = LE(psed->physaddr);
667 1.1 augustss }
668 1.1 augustss /*
669 1.1 augustss * Fill HCCA interrupt table. The bit reversal is to get
670 1.1 augustss * the tree set up properly to spread the interrupts.
671 1.1 augustss */
672 1.1 augustss for (i = 0; i < OHCI_NO_INTRS; i++)
673 1.1 augustss sc->sc_hcca->hcca_interrupt_table[revbits[i]] =
674 1.16 augustss LE(sc->sc_eds[OHCI_NO_EDS-OHCI_NO_INTRS+i]->physaddr);
675 1.1 augustss
676 1.1 augustss /* Determine in what context we are running. */
677 1.1 augustss ctl = OREAD4(sc, OHCI_CONTROL);
678 1.1 augustss if (ctl & OHCI_IR) {
679 1.1 augustss /* SMM active, request change */
680 1.1 augustss DPRINTF(("ohci_init: SMM active, request owner change\n"));
681 1.1 augustss s = OREAD4(sc, OHCI_COMMAND_STATUS);
682 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, s | OHCI_OCR);
683 1.1 augustss for (i = 0; i < 100 && (ctl & OHCI_IR); i++) {
684 1.53 augustss usb_delay_ms(&sc->sc_bus, 1);
685 1.1 augustss ctl = OREAD4(sc, OHCI_CONTROL);
686 1.1 augustss }
687 1.1 augustss if ((ctl & OHCI_IR) == 0) {
688 1.15 augustss printf("%s: SMM does not respond, resetting\n",
689 1.15 augustss USBDEVNAME(sc->sc_bus.bdev));
690 1.1 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
691 1.1 augustss goto reset;
692 1.1 augustss }
693 1.1 augustss } else if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_RESET) {
694 1.1 augustss /* BIOS started controller. */
695 1.1 augustss DPRINTF(("ohci_init: BIOS active\n"));
696 1.1 augustss if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_OPERATIONAL) {
697 1.1 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_OPERATIONAL);
698 1.53 augustss usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
699 1.1 augustss }
700 1.1 augustss } else {
701 1.1 augustss DPRINTF(("ohci_init: cold started\n"));
702 1.1 augustss reset:
703 1.1 augustss /* Controller was cold started. */
704 1.53 augustss usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY);
705 1.1 augustss }
706 1.1 augustss
707 1.16 augustss /*
708 1.25 augustss * This reset should not be necessary according to the OHCI spec, but
709 1.25 augustss * without it some controllers do not start.
710 1.16 augustss */
711 1.16 augustss DPRINTF(("%s: resetting\n", USBDEVNAME(sc->sc_bus.bdev)));
712 1.16 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
713 1.55 augustss usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY);
714 1.16 augustss
715 1.1 augustss /* We now own the host controller and the bus has been reset. */
716 1.1 augustss ival = OHCI_GET_IVAL(OREAD4(sc, OHCI_FM_INTERVAL));
717 1.1 augustss
718 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_HCR); /* Reset HC */
719 1.1 augustss /* Nominal time for a reset is 10 us. */
720 1.1 augustss for (i = 0; i < 10; i++) {
721 1.1 augustss delay(10);
722 1.1 augustss hcr = OREAD4(sc, OHCI_COMMAND_STATUS) & OHCI_HCR;
723 1.1 augustss if (!hcr)
724 1.1 augustss break;
725 1.1 augustss }
726 1.1 augustss if (hcr) {
727 1.15 augustss printf("%s: reset timeout\n", USBDEVNAME(sc->sc_bus.bdev));
728 1.53 augustss err = USBD_IOERROR;
729 1.60 augustss goto bad5;
730 1.1 augustss }
731 1.52 augustss #ifdef OHCI_DEBUG
732 1.1 augustss if (ohcidebug > 15)
733 1.1 augustss ohci_dumpregs(sc);
734 1.1 augustss #endif
735 1.1 augustss
736 1.60 augustss /* The controller is now in SUSPEND state, we have 2ms to finish. */
737 1.1 augustss
738 1.1 augustss /* Set up HC registers. */
739 1.1 augustss OWRITE4(sc, OHCI_HCCA, DMAADDR(&sc->sc_hccadma));
740 1.1 augustss OWRITE4(sc, OHCI_CONTROL_HEAD_ED, sc->sc_ctrl_head->physaddr);
741 1.1 augustss OWRITE4(sc, OHCI_BULK_HEAD_ED, sc->sc_bulk_head->physaddr);
742 1.55 augustss /* disable all interrupts and then switch on all desired interrupts */
743 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_ALL_INTRS);
744 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_ENABLE, sc->sc_eintrs | OHCI_MIE);
745 1.55 augustss /* switch on desired functional features */
746 1.1 augustss ctl = OREAD4(sc, OHCI_CONTROL);
747 1.1 augustss ctl &= ~(OHCI_CBSR_MASK | OHCI_LES | OHCI_HCFS_MASK | OHCI_IR);
748 1.1 augustss ctl |= OHCI_PLE | OHCI_IE | OHCI_CLE | OHCI_BLE |
749 1.1 augustss OHCI_RATIO_1_4 | OHCI_HCFS_OPERATIONAL;
750 1.1 augustss /* And finally start it! */
751 1.1 augustss OWRITE4(sc, OHCI_CONTROL, ctl);
752 1.1 augustss
753 1.1 augustss /*
754 1.1 augustss * The controller is now OPERATIONAL. Set a some final
755 1.1 augustss * registers that should be set earlier, but that the
756 1.1 augustss * controller ignores when in the SUSPEND state.
757 1.1 augustss */
758 1.1 augustss fm = (OREAD4(sc, OHCI_FM_INTERVAL) & OHCI_FIT) ^ OHCI_FIT;
759 1.1 augustss fm |= OHCI_FSMPS(ival) | ival;
760 1.1 augustss OWRITE4(sc, OHCI_FM_INTERVAL, fm);
761 1.1 augustss per = OHCI_PERIODIC(ival); /* 90% periodic */
762 1.1 augustss OWRITE4(sc, OHCI_PERIODIC_START, per);
763 1.1 augustss
764 1.1 augustss OWRITE4(sc, OHCI_RH_STATUS, OHCI_LPSC); /* Enable port power */
765 1.1 augustss
766 1.1 augustss sc->sc_noport = OHCI_GET_NDP(OREAD4(sc, OHCI_RH_DESCRIPTOR_A));
767 1.1 augustss
768 1.52 augustss #ifdef OHCI_DEBUG
769 1.1 augustss if (ohcidebug > 5)
770 1.1 augustss ohci_dumpregs(sc);
771 1.1 augustss #endif
772 1.1 augustss
773 1.1 augustss /* Set up the bus struct. */
774 1.42 augustss sc->sc_bus.methods = &ohci_bus_methods;
775 1.1 augustss sc->sc_bus.pipe_size = sizeof(struct ohci_pipe);
776 1.1 augustss
777 1.47 augustss sc->sc_powerhook = powerhook_establish(ohci_power, sc);
778 1.33 augustss
779 1.59 augustss sc->sc_shutdownhook = shutdownhook_establish(ohci_shutdown, sc);
780 1.59 augustss
781 1.1 augustss return (USBD_NORMAL_COMPLETION);
782 1.1 augustss
783 1.60 augustss bad5:
784 1.60 augustss for (i = 0; i < OHCI_NO_EDS; i++)
785 1.60 augustss ohci_free_sed(sc, sc->sc_eds[i]);
786 1.60 augustss bad4:
787 1.60 augustss ohci_free_sed(sc, sc->sc_isoc_head);
788 1.1 augustss bad3:
789 1.1 augustss ohci_free_sed(sc, sc->sc_ctrl_head);
790 1.1 augustss bad2:
791 1.1 augustss ohci_free_sed(sc, sc->sc_bulk_head);
792 1.1 augustss bad1:
793 1.44 augustss usb_freemem(&sc->sc_bus, &sc->sc_hccadma);
794 1.53 augustss return (err);
795 1.1 augustss }
796 1.1 augustss
797 1.42 augustss usbd_status
798 1.42 augustss ohci_allocm(bus, dma, size)
799 1.42 augustss struct usbd_bus *bus;
800 1.42 augustss usb_dma_t *dma;
801 1.42 augustss u_int32_t size;
802 1.42 augustss {
803 1.52 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
804 1.42 augustss struct ohci_softc *sc = (struct ohci_softc *)bus;
805 1.52 augustss #endif
806 1.42 augustss
807 1.44 augustss return (usb_allocmem(&sc->sc_bus, size, 0, dma));
808 1.42 augustss }
809 1.42 augustss
810 1.42 augustss void
811 1.42 augustss ohci_freem(bus, dma)
812 1.42 augustss struct usbd_bus *bus;
813 1.42 augustss usb_dma_t *dma;
814 1.42 augustss {
815 1.52 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
816 1.42 augustss struct ohci_softc *sc = (struct ohci_softc *)bus;
817 1.52 augustss #endif
818 1.42 augustss
819 1.44 augustss usb_freemem(&sc->sc_bus, dma);
820 1.42 augustss }
821 1.42 augustss
822 1.59 augustss /*
823 1.59 augustss * Shut down the controller when the system is going down.
824 1.59 augustss */
825 1.59 augustss void
826 1.59 augustss ohci_shutdown(v)
827 1.59 augustss void *v;
828 1.59 augustss {
829 1.59 augustss ohci_softc_t *sc = v;
830 1.59 augustss
831 1.59 augustss DPRINTF(("ohci_shutdown: stopping the HC\n"));
832 1.59 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
833 1.59 augustss }
834 1.59 augustss
835 1.59 augustss /*
836 1.59 augustss * Handle suspend/resume.
837 1.59 augustss *
838 1.59 augustss * We need to switch to polling mode here, because this routine is
839 1.59 augustss * called from an intterupt context. This is all right since we
840 1.59 augustss * are almost suspended anyway.
841 1.59 augustss */
842 1.33 augustss void
843 1.33 augustss ohci_power(why, v)
844 1.33 augustss int why;
845 1.33 augustss void *v;
846 1.33 augustss {
847 1.52 augustss #ifdef OHCI_DEBUG
848 1.33 augustss ohci_softc_t *sc = v;
849 1.33 augustss
850 1.41 augustss DPRINTF(("ohci_power: sc=%p, why=%d\n", sc, why));
851 1.33 augustss /* XXX should suspend/resume */
852 1.33 augustss ohci_dumpregs(sc);
853 1.33 augustss #endif
854 1.33 augustss }
855 1.33 augustss
856 1.52 augustss #ifdef OHCI_DEBUG
857 1.1 augustss void
858 1.1 augustss ohci_dumpregs(sc)
859 1.1 augustss ohci_softc_t *sc;
860 1.1 augustss {
861 1.41 augustss DPRINTF(("ohci_dumpregs: rev=0x%08x control=0x%08x command=0x%08x\n",
862 1.41 augustss OREAD4(sc, OHCI_REVISION),
863 1.41 augustss OREAD4(sc, OHCI_CONTROL),
864 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
865 1.41 augustss DPRINTF((" intrstat=0x%08x intre=0x%08x intrd=0x%08x\n",
866 1.41 augustss OREAD4(sc, OHCI_INTERRUPT_STATUS),
867 1.41 augustss OREAD4(sc, OHCI_INTERRUPT_ENABLE),
868 1.41 augustss OREAD4(sc, OHCI_INTERRUPT_DISABLE)));
869 1.41 augustss DPRINTF((" hcca=0x%08x percur=0x%08x ctrlhd=0x%08x\n",
870 1.41 augustss OREAD4(sc, OHCI_HCCA),
871 1.41 augustss OREAD4(sc, OHCI_PERIOD_CURRENT_ED),
872 1.41 augustss OREAD4(sc, OHCI_CONTROL_HEAD_ED)));
873 1.41 augustss DPRINTF((" ctrlcur=0x%08x bulkhd=0x%08x bulkcur=0x%08x\n",
874 1.41 augustss OREAD4(sc, OHCI_CONTROL_CURRENT_ED),
875 1.41 augustss OREAD4(sc, OHCI_BULK_HEAD_ED),
876 1.41 augustss OREAD4(sc, OHCI_BULK_CURRENT_ED)));
877 1.41 augustss DPRINTF((" done=0x%08x fmival=0x%08x fmrem=0x%08x\n",
878 1.41 augustss OREAD4(sc, OHCI_DONE_HEAD),
879 1.41 augustss OREAD4(sc, OHCI_FM_INTERVAL),
880 1.41 augustss OREAD4(sc, OHCI_FM_REMAINING)));
881 1.41 augustss DPRINTF((" fmnum=0x%08x perst=0x%08x lsthrs=0x%08x\n",
882 1.41 augustss OREAD4(sc, OHCI_FM_NUMBER),
883 1.41 augustss OREAD4(sc, OHCI_PERIODIC_START),
884 1.41 augustss OREAD4(sc, OHCI_LS_THRESHOLD)));
885 1.41 augustss DPRINTF((" desca=0x%08x descb=0x%08x stat=0x%08x\n",
886 1.41 augustss OREAD4(sc, OHCI_RH_DESCRIPTOR_A),
887 1.41 augustss OREAD4(sc, OHCI_RH_DESCRIPTOR_B),
888 1.41 augustss OREAD4(sc, OHCI_RH_STATUS)));
889 1.41 augustss DPRINTF((" port1=0x%08x port2=0x%08x\n",
890 1.41 augustss OREAD4(sc, OHCI_RH_PORT_STATUS(1)),
891 1.41 augustss OREAD4(sc, OHCI_RH_PORT_STATUS(2))));
892 1.41 augustss DPRINTF((" HCCA: frame_number=0x%04x done_head=0x%08x\n",
893 1.41 augustss LE(sc->sc_hcca->hcca_frame_number),
894 1.41 augustss LE(sc->sc_hcca->hcca_done_head)));
895 1.1 augustss }
896 1.1 augustss #endif
897 1.1 augustss
898 1.55 augustss static int ohci_intr1 __P((ohci_softc_t *));
899 1.53 augustss
900 1.1 augustss int
901 1.1 augustss ohci_intr(p)
902 1.1 augustss void *p;
903 1.1 augustss {
904 1.1 augustss ohci_softc_t *sc = p;
905 1.53 augustss
906 1.53 augustss /* If we get an interrupt while polling, then just ignore it. */
907 1.57 augustss if (sc->sc_bus.use_polling) {
908 1.57 augustss #ifdef DIAGNOSTIC
909 1.57 augustss printf("ohci_intr: ignored interrupt while polling\n");
910 1.57 augustss #endif
911 1.53 augustss return (0);
912 1.57 augustss }
913 1.53 augustss
914 1.53 augustss return (ohci_intr1(sc));
915 1.53 augustss }
916 1.53 augustss
917 1.55 augustss static int
918 1.53 augustss ohci_intr1(sc)
919 1.53 augustss ohci_softc_t *sc;
920 1.53 augustss {
921 1.1 augustss u_int32_t intrs, eintrs;
922 1.1 augustss ohci_physaddr_t done;
923 1.1 augustss
924 1.15 augustss /* In case the interrupt occurs before initialization has completed. */
925 1.34 augustss if (sc == NULL || sc->sc_hcca == NULL) {
926 1.15 augustss #ifdef DIAGNOSTIC
927 1.15 augustss printf("ohci_intr: sc->sc_hcca == NULL\n");
928 1.15 augustss #endif
929 1.15 augustss return (0);
930 1.15 augustss }
931 1.15 augustss
932 1.27 augustss intrs = 0;
933 1.16 augustss done = LE(sc->sc_hcca->hcca_done_head);
934 1.1 augustss if (done != 0) {
935 1.26 augustss sc->sc_hcca->hcca_done_head = 0;
936 1.26 augustss if (done & ~OHCI_DONE_INTRS)
937 1.26 augustss intrs = OHCI_WDH;
938 1.1 augustss if (done & OHCI_DONE_INTRS)
939 1.1 augustss intrs |= OREAD4(sc, OHCI_INTERRUPT_STATUS);
940 1.1 augustss } else
941 1.1 augustss intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS);
942 1.55 augustss
943 1.1 augustss if (!intrs)
944 1.1 augustss return (0);
945 1.55 augustss
946 1.1 augustss intrs &= ~OHCI_MIE;
947 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_STATUS, intrs); /* Acknowledge */
948 1.1 augustss eintrs = intrs & sc->sc_eintrs;
949 1.1 augustss if (!eintrs)
950 1.1 augustss return (0);
951 1.1 augustss
952 1.45 augustss sc->sc_bus.intr_context++;
953 1.44 augustss sc->sc_bus.no_intrs++;
954 1.1 augustss DPRINTFN(7, ("ohci_intr: sc=%p intrs=%x(%x) eintr=%x\n",
955 1.1 augustss sc, (u_int)intrs, OREAD4(sc, OHCI_INTERRUPT_STATUS),
956 1.1 augustss (u_int)eintrs));
957 1.1 augustss
958 1.1 augustss if (eintrs & OHCI_SO) {
959 1.15 augustss printf("%s: scheduling overrun\n",USBDEVNAME(sc->sc_bus.bdev));
960 1.1 augustss /* XXX do what */
961 1.1 augustss intrs &= ~OHCI_SO;
962 1.1 augustss }
963 1.1 augustss if (eintrs & OHCI_WDH) {
964 1.1 augustss ohci_process_done(sc, done &~ OHCI_DONE_INTRS);
965 1.1 augustss intrs &= ~OHCI_WDH;
966 1.1 augustss }
967 1.1 augustss if (eintrs & OHCI_RD) {
968 1.33 augustss printf("%s: resume detect\n", USBDEVNAME(sc->sc_bus.bdev));
969 1.1 augustss /* XXX process resume detect */
970 1.1 augustss }
971 1.1 augustss if (eintrs & OHCI_UE) {
972 1.15 augustss printf("%s: unrecoverable error, controller halted\n",
973 1.15 augustss USBDEVNAME(sc->sc_bus.bdev));
974 1.1 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
975 1.1 augustss /* XXX what else */
976 1.1 augustss }
977 1.1 augustss if (eintrs & OHCI_RHSC) {
978 1.53 augustss ohci_rhsc(sc, sc->sc_intrxfer);
979 1.1 augustss intrs &= ~OHCI_RHSC;
980 1.1 augustss
981 1.1 augustss /*
982 1.1 augustss * Disable RHSC interrupt for now, because it will be
983 1.1 augustss * on until the port has been reset.
984 1.1 augustss */
985 1.1 augustss ohci_rhsc_able(sc, 0);
986 1.1 augustss }
987 1.1 augustss
988 1.45 augustss sc->sc_bus.intr_context--;
989 1.44 augustss
990 1.1 augustss /* Block unprocessed interrupts. XXX */
991 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_DISABLE, intrs);
992 1.1 augustss sc->sc_eintrs &= ~intrs;
993 1.1 augustss
994 1.1 augustss return (1);
995 1.1 augustss }
996 1.1 augustss
997 1.1 augustss void
998 1.1 augustss ohci_rhsc_able(sc, on)
999 1.1 augustss ohci_softc_t *sc;
1000 1.1 augustss int on;
1001 1.1 augustss {
1002 1.1 augustss DPRINTFN(4, ("ohci_rhsc_able: on=%d\n", on));
1003 1.1 augustss if (on) {
1004 1.1 augustss sc->sc_eintrs |= OHCI_RHSC;
1005 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_RHSC);
1006 1.1 augustss } else {
1007 1.1 augustss sc->sc_eintrs &= ~OHCI_RHSC;
1008 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_RHSC);
1009 1.1 augustss }
1010 1.1 augustss }
1011 1.1 augustss
1012 1.52 augustss #ifdef OHCI_DEBUG
1013 1.13 augustss char *ohci_cc_strs[] = {
1014 1.13 augustss "NO_ERROR",
1015 1.13 augustss "CRC",
1016 1.13 augustss "BIT_STUFFING",
1017 1.13 augustss "DATA_TOGGLE_MISMATCH",
1018 1.13 augustss "STALL",
1019 1.13 augustss "DEVICE_NOT_RESPONDING",
1020 1.13 augustss "PID_CHECK_FAILURE",
1021 1.13 augustss "UNEXPECTED_PID",
1022 1.13 augustss "DATA_OVERRUN",
1023 1.13 augustss "DATA_UNDERRUN",
1024 1.13 augustss "BUFFER_OVERRUN",
1025 1.13 augustss "BUFFER_UNDERRUN",
1026 1.13 augustss "NOT_ACCESSED",
1027 1.13 augustss };
1028 1.13 augustss #endif
1029 1.13 augustss
1030 1.1 augustss void
1031 1.1 augustss ohci_process_done(sc, done)
1032 1.1 augustss ohci_softc_t *sc;
1033 1.1 augustss ohci_physaddr_t done;
1034 1.1 augustss {
1035 1.48 augustss ohci_soft_td_t *std, *sdone, *stdnext;
1036 1.53 augustss usbd_xfer_handle xfer;
1037 1.1 augustss int len, cc;
1038 1.1 augustss
1039 1.1 augustss DPRINTFN(10,("ohci_process_done: done=0x%08lx\n", (u_long)done));
1040 1.1 augustss
1041 1.1 augustss /* Reverse the done list. */
1042 1.39 augustss for (sdone = 0; done; done = LE(std->td.td_nexttd)) {
1043 1.1 augustss std = ohci_hash_find_td(sc, done);
1044 1.1 augustss std->dnext = sdone;
1045 1.1 augustss sdone = std;
1046 1.1 augustss }
1047 1.1 augustss
1048 1.52 augustss #ifdef OHCI_DEBUG
1049 1.1 augustss if (ohcidebug > 10) {
1050 1.41 augustss DPRINTF(("ohci_process_done: TD done:\n"));
1051 1.1 augustss ohci_dump_tds(sdone);
1052 1.1 augustss }
1053 1.1 augustss #endif
1054 1.1 augustss
1055 1.48 augustss for (std = sdone; std; std = stdnext) {
1056 1.53 augustss xfer = std->xfer;
1057 1.48 augustss stdnext = std->dnext;
1058 1.53 augustss DPRINTFN(10, ("ohci_process_done: std=%p xfer=%p hcpriv=%p\n",
1059 1.53 augustss std, xfer, xfer->hcpriv));
1060 1.39 augustss cc = OHCI_TD_GET_CC(LE(std->td.td_flags));
1061 1.53 augustss usb_untimeout(ohci_timeout, xfer, xfer->timo_handle);
1062 1.53 augustss if (xfer->status == USBD_CANCELLED ||
1063 1.53 augustss xfer->status == USBD_TIMEOUT) {
1064 1.34 augustss DPRINTF(("ohci_process_done: cancel/timeout %p\n",
1065 1.53 augustss xfer));
1066 1.38 augustss /* Handled by abort routine. */
1067 1.34 augustss } else if (cc == OHCI_CC_NO_ERROR) {
1068 1.34 augustss len = std->len;
1069 1.39 augustss if (std->td.td_cbp != 0)
1070 1.39 augustss len -= LE(std->td.td_be) -
1071 1.39 augustss LE(std->td.td_cbp) + 1;
1072 1.48 augustss if (std->flags & OHCI_ADD_LEN)
1073 1.53 augustss xfer->actlen += len;
1074 1.34 augustss if (std->flags & OHCI_CALL_DONE) {
1075 1.53 augustss xfer->status = USBD_NORMAL_COMPLETION;
1076 1.53 augustss usb_transfer_complete(xfer);
1077 1.21 augustss }
1078 1.48 augustss ohci_hash_rem_td(sc, std);
1079 1.48 augustss ohci_free_std(sc, std);
1080 1.1 augustss } else {
1081 1.48 augustss /*
1082 1.48 augustss * Endpoint is halted. First unlink all the TDs
1083 1.48 augustss * belonging to the failed transfer, and then restart
1084 1.48 augustss * the endpoint.
1085 1.48 augustss */
1086 1.1 augustss ohci_soft_td_t *p, *n;
1087 1.1 augustss struct ohci_pipe *opipe =
1088 1.53 augustss (struct ohci_pipe *)xfer->pipe;
1089 1.48 augustss
1090 1.55 augustss DPRINTF(("ohci_process_done: error cc=%d (%s)\n",
1091 1.53 augustss OHCI_TD_GET_CC(LE(std->td.td_flags)),
1092 1.53 augustss ohci_cc_strs[OHCI_TD_GET_CC(LE(std->td.td_flags))]));
1093 1.48 augustss
1094 1.48 augustss /* remove TDs */
1095 1.53 augustss for (p = std; p->xfer == xfer; p = n) {
1096 1.1 augustss n = p->nexttd;
1097 1.1 augustss ohci_hash_rem_td(sc, p);
1098 1.1 augustss ohci_free_std(sc, p);
1099 1.1 augustss }
1100 1.48 augustss
1101 1.16 augustss /* clear halt */
1102 1.39 augustss opipe->sed->ed.ed_headp = LE(p->physaddr);
1103 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
1104 1.48 augustss
1105 1.1 augustss if (cc == OHCI_CC_STALL)
1106 1.53 augustss xfer->status = USBD_STALLED;
1107 1.1 augustss else
1108 1.53 augustss xfer->status = USBD_IOERROR;
1109 1.53 augustss usb_transfer_complete(xfer);
1110 1.1 augustss }
1111 1.1 augustss }
1112 1.1 augustss }
1113 1.1 augustss
1114 1.1 augustss void
1115 1.53 augustss ohci_device_ctrl_done(xfer)
1116 1.53 augustss usbd_xfer_handle xfer;
1117 1.1 augustss {
1118 1.53 augustss DPRINTFN(10,("ohci_ctrl_done: xfer=%p\n", xfer));
1119 1.1 augustss
1120 1.38 augustss #ifdef DIAGNOSTIC
1121 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST)) {
1122 1.8 augustss panic("ohci_ctrl_done: not a request\n");
1123 1.1 augustss }
1124 1.38 augustss #endif
1125 1.55 augustss xfer->hcpriv = NULL;
1126 1.1 augustss }
1127 1.1 augustss
1128 1.1 augustss void
1129 1.53 augustss ohci_device_intr_done(xfer)
1130 1.53 augustss usbd_xfer_handle xfer;
1131 1.1 augustss {
1132 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1133 1.38 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
1134 1.1 augustss ohci_soft_ed_t *sed = opipe->sed;
1135 1.48 augustss ohci_soft_td_t *data, *tail;
1136 1.1 augustss
1137 1.1 augustss
1138 1.53 augustss DPRINTFN(10,("ohci_intr_done: xfer=%p, actlen=%d\n",
1139 1.53 augustss xfer, xfer->actlen));
1140 1.1 augustss
1141 1.55 augustss xfer->hcpriv = NULL;
1142 1.38 augustss
1143 1.53 augustss if (xfer->pipe->repeat) {
1144 1.60 augustss data = opipe->tail.td;
1145 1.1 augustss tail = ohci_alloc_std(sc); /* XXX should reuse TD */
1146 1.53 augustss if (tail == NULL) {
1147 1.53 augustss xfer->status = USBD_NOMEM;
1148 1.1 augustss return;
1149 1.1 augustss }
1150 1.55 augustss tail->xfer = NULL;
1151 1.1 augustss
1152 1.48 augustss data->td.td_flags = LE(
1153 1.16 augustss OHCI_TD_IN | OHCI_TD_NOCC |
1154 1.16 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
1155 1.53 augustss if (xfer->flags & USBD_SHORT_XFER_OK)
1156 1.48 augustss data->td.td_flags |= LE(OHCI_TD_R);
1157 1.53 augustss data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
1158 1.48 augustss data->nexttd = tail;
1159 1.48 augustss data->td.td_nexttd = LE(tail->physaddr);
1160 1.53 augustss data->td.td_be = LE(LE(data->td.td_cbp) + xfer->length - 1);
1161 1.53 augustss data->len = xfer->length;
1162 1.53 augustss data->xfer = xfer;
1163 1.48 augustss data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
1164 1.53 augustss xfer->hcpriv = data;
1165 1.53 augustss xfer->actlen = 0;
1166 1.1 augustss
1167 1.48 augustss ohci_hash_add_td(sc, data);
1168 1.39 augustss sed->ed.ed_tailp = LE(tail->physaddr);
1169 1.60 augustss opipe->tail.td = tail;
1170 1.1 augustss }
1171 1.1 augustss }
1172 1.1 augustss
1173 1.1 augustss void
1174 1.53 augustss ohci_device_bulk_done(xfer)
1175 1.53 augustss usbd_xfer_handle xfer;
1176 1.3 augustss {
1177 1.53 augustss DPRINTFN(10,("ohci_bulk_done: xfer=%p, actlen=%d\n",
1178 1.53 augustss xfer, xfer->actlen));
1179 1.3 augustss
1180 1.53 augustss xfer->hcpriv = NULL;
1181 1.3 augustss }
1182 1.3 augustss
1183 1.3 augustss void
1184 1.53 augustss ohci_rhsc(sc, xfer)
1185 1.1 augustss ohci_softc_t *sc;
1186 1.53 augustss usbd_xfer_handle xfer;
1187 1.1 augustss {
1188 1.1 augustss usbd_pipe_handle pipe;
1189 1.1 augustss struct ohci_pipe *opipe;
1190 1.1 augustss u_char *p;
1191 1.1 augustss int i, m;
1192 1.1 augustss int hstatus;
1193 1.1 augustss
1194 1.1 augustss hstatus = OREAD4(sc, OHCI_RH_STATUS);
1195 1.53 augustss DPRINTF(("ohci_rhsc: sc=%p xfer=%p hstatus=0x%08x\n",
1196 1.53 augustss sc, xfer, hstatus));
1197 1.1 augustss
1198 1.53 augustss if (xfer == NULL) {
1199 1.1 augustss /* Just ignore the change. */
1200 1.1 augustss return;
1201 1.1 augustss }
1202 1.1 augustss
1203 1.53 augustss pipe = xfer->pipe;
1204 1.1 augustss opipe = (struct ohci_pipe *)pipe;
1205 1.1 augustss
1206 1.53 augustss p = KERNADDR(&xfer->dmabuf);
1207 1.53 augustss m = min(sc->sc_noport, xfer->length * 8 - 1);
1208 1.53 augustss memset(p, 0, xfer->length);
1209 1.1 augustss for (i = 1; i <= m; i++) {
1210 1.1 augustss if (OREAD4(sc, OHCI_RH_PORT_STATUS(i)) >> 16)
1211 1.1 augustss p[i/8] |= 1 << (i%8);
1212 1.1 augustss }
1213 1.1 augustss DPRINTF(("ohci_rhsc: change=0x%02x\n", *p));
1214 1.53 augustss xfer->actlen = xfer->length;
1215 1.53 augustss xfer->status = USBD_NORMAL_COMPLETION;
1216 1.1 augustss
1217 1.53 augustss usb_transfer_complete(xfer);
1218 1.38 augustss }
1219 1.38 augustss
1220 1.38 augustss void
1221 1.53 augustss ohci_root_intr_done(xfer)
1222 1.53 augustss usbd_xfer_handle xfer;
1223 1.38 augustss {
1224 1.53 augustss xfer->hcpriv = NULL;
1225 1.1 augustss }
1226 1.1 augustss
1227 1.1 augustss /*
1228 1.1 augustss * Wait here until controller claims to have an interrupt.
1229 1.1 augustss * Then call ohci_intr and return. Use timeout to avoid waiting
1230 1.1 augustss * too long.
1231 1.1 augustss */
1232 1.1 augustss void
1233 1.53 augustss ohci_waitintr(sc, xfer)
1234 1.1 augustss ohci_softc_t *sc;
1235 1.53 augustss usbd_xfer_handle xfer;
1236 1.1 augustss {
1237 1.53 augustss int timo = xfer->timeout;
1238 1.1 augustss int usecs;
1239 1.1 augustss u_int32_t intrs;
1240 1.1 augustss
1241 1.53 augustss xfer->status = USBD_IN_PROGRESS;
1242 1.1 augustss for (usecs = timo * 1000000 / hz; usecs > 0; usecs -= 1000) {
1243 1.20 augustss usb_delay_ms(&sc->sc_bus, 1);
1244 1.1 augustss intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs;
1245 1.27 augustss DPRINTFN(15,("ohci_waitintr: 0x%04x\n", intrs));
1246 1.52 augustss #ifdef OHCI_DEBUG
1247 1.1 augustss if (ohcidebug > 15)
1248 1.1 augustss ohci_dumpregs(sc);
1249 1.1 augustss #endif
1250 1.1 augustss if (intrs) {
1251 1.53 augustss ohci_intr1(sc);
1252 1.53 augustss if (xfer->status != USBD_IN_PROGRESS)
1253 1.1 augustss return;
1254 1.1 augustss }
1255 1.1 augustss }
1256 1.15 augustss
1257 1.15 augustss /* Timeout */
1258 1.1 augustss DPRINTF(("ohci_waitintr: timeout\n"));
1259 1.53 augustss xfer->status = USBD_TIMEOUT;
1260 1.53 augustss usb_transfer_complete(xfer);
1261 1.15 augustss /* XXX should free TD */
1262 1.5 augustss }
1263 1.5 augustss
1264 1.5 augustss void
1265 1.5 augustss ohci_poll(bus)
1266 1.5 augustss struct usbd_bus *bus;
1267 1.5 augustss {
1268 1.5 augustss ohci_softc_t *sc = (ohci_softc_t *)bus;
1269 1.5 augustss
1270 1.5 augustss if (OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs)
1271 1.53 augustss ohci_intr1(sc);
1272 1.1 augustss }
1273 1.1 augustss
1274 1.1 augustss usbd_status
1275 1.53 augustss ohci_device_request(xfer)
1276 1.53 augustss usbd_xfer_handle xfer;
1277 1.1 augustss {
1278 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1279 1.53 augustss usb_device_request_t *req = &xfer->request;
1280 1.1 augustss usbd_device_handle dev = opipe->pipe.device;
1281 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1282 1.1 augustss int addr = dev->address;
1283 1.48 augustss ohci_soft_td_t *setup, *data = 0, *stat, *next, *tail;
1284 1.1 augustss ohci_soft_ed_t *sed;
1285 1.1 augustss int isread;
1286 1.1 augustss int len;
1287 1.53 augustss usbd_status err;
1288 1.1 augustss int s;
1289 1.1 augustss
1290 1.1 augustss isread = req->bmRequestType & UT_READ;
1291 1.1 augustss len = UGETW(req->wLength);
1292 1.1 augustss
1293 1.14 augustss DPRINTFN(3,("ohci_device_control type=0x%02x, request=0x%02x, "
1294 1.14 augustss "wValue=0x%04x, wIndex=0x%04x len=%d, addr=%d, endpt=%d\n",
1295 1.1 augustss req->bmRequestType, req->bRequest, UGETW(req->wValue),
1296 1.1 augustss UGETW(req->wIndex), len, addr,
1297 1.1 augustss opipe->pipe.endpoint->edesc->bEndpointAddress));
1298 1.1 augustss
1299 1.60 augustss setup = opipe->tail.td;
1300 1.1 augustss stat = ohci_alloc_std(sc);
1301 1.53 augustss if (stat == NULL) {
1302 1.53 augustss err = USBD_NOMEM;
1303 1.1 augustss goto bad1;
1304 1.1 augustss }
1305 1.1 augustss tail = ohci_alloc_std(sc);
1306 1.53 augustss if (tail == NULL) {
1307 1.53 augustss err = USBD_NOMEM;
1308 1.1 augustss goto bad2;
1309 1.1 augustss }
1310 1.55 augustss tail->xfer = NULL;
1311 1.1 augustss
1312 1.1 augustss sed = opipe->sed;
1313 1.1 augustss opipe->u.ctl.length = len;
1314 1.1 augustss
1315 1.10 augustss /* Update device address and length since they may have changed. */
1316 1.10 augustss /* XXX This only needs to be done once, but it's too early in open. */
1317 1.39 augustss sed->ed.ed_flags = LE(
1318 1.39 augustss (LE(sed->ed.ed_flags) & ~(OHCI_ED_ADDRMASK | OHCI_ED_MAXPMASK)) |
1319 1.16 augustss OHCI_ED_SET_FA(addr) |
1320 1.16 augustss OHCI_ED_SET_MAXP(UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize)));
1321 1.1 augustss
1322 1.1 augustss /* Set up data transaction */
1323 1.1 augustss if (len != 0) {
1324 1.48 augustss data = ohci_alloc_std(sc);
1325 1.53 augustss if (data == NULL) {
1326 1.53 augustss err = USBD_NOMEM;
1327 1.1 augustss goto bad3;
1328 1.1 augustss }
1329 1.48 augustss data->td.td_flags = LE(
1330 1.1 augustss (isread ? OHCI_TD_IN : OHCI_TD_OUT) | OHCI_TD_NOCC |
1331 1.19 augustss OHCI_TD_TOGGLE_1 | OHCI_TD_NOINTR |
1332 1.53 augustss (xfer->flags & USBD_SHORT_XFER_OK ? OHCI_TD_R : 0));
1333 1.53 augustss data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
1334 1.48 augustss data->nexttd = stat;
1335 1.48 augustss data->td.td_nexttd = LE(stat->physaddr);
1336 1.48 augustss data->td.td_be = LE(LE(data->td.td_cbp) + len - 1);
1337 1.48 augustss data->len = len;
1338 1.53 augustss data->xfer = xfer;
1339 1.48 augustss data->flags = OHCI_ADD_LEN;
1340 1.1 augustss
1341 1.48 augustss next = data;
1342 1.34 augustss stat->flags = OHCI_CALL_DONE;
1343 1.34 augustss } else {
1344 1.1 augustss next = stat;
1345 1.48 augustss /* XXX ADD_LEN? */
1346 1.48 augustss stat->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
1347 1.34 augustss }
1348 1.1 augustss
1349 1.1 augustss memcpy(KERNADDR(&opipe->u.ctl.reqdma), req, sizeof *req);
1350 1.1 augustss
1351 1.39 augustss setup->td.td_flags = LE(OHCI_TD_SETUP | OHCI_TD_NOCC |
1352 1.58 augustss OHCI_TD_TOGGLE_0 | OHCI_TD_NOINTR);
1353 1.39 augustss setup->td.td_cbp = LE(DMAADDR(&opipe->u.ctl.reqdma));
1354 1.1 augustss setup->nexttd = next;
1355 1.39 augustss setup->td.td_nexttd = LE(next->physaddr);
1356 1.39 augustss setup->td.td_be = LE(LE(setup->td.td_cbp) + sizeof *req - 1);
1357 1.1 augustss setup->len = 0; /* XXX The number of byte we count */
1358 1.53 augustss setup->xfer = xfer;
1359 1.34 augustss setup->flags = 0;
1360 1.53 augustss xfer->hcpriv = setup;
1361 1.1 augustss
1362 1.39 augustss stat->td.td_flags = LE(
1363 1.1 augustss (isread ? OHCI_TD_OUT : OHCI_TD_IN) | OHCI_TD_NOCC |
1364 1.16 augustss OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1));
1365 1.39 augustss stat->td.td_cbp = 0;
1366 1.1 augustss stat->nexttd = tail;
1367 1.39 augustss stat->td.td_nexttd = LE(tail->physaddr);
1368 1.39 augustss stat->td.td_be = 0;
1369 1.1 augustss stat->len = 0;
1370 1.53 augustss stat->xfer = xfer;
1371 1.1 augustss
1372 1.52 augustss #ifdef OHCI_DEBUG
1373 1.1 augustss if (ohcidebug > 5) {
1374 1.41 augustss DPRINTF(("ohci_device_request:\n"));
1375 1.1 augustss ohci_dump_ed(sed);
1376 1.1 augustss ohci_dump_tds(setup);
1377 1.1 augustss }
1378 1.1 augustss #endif
1379 1.1 augustss
1380 1.1 augustss /* Insert ED in schedule */
1381 1.1 augustss s = splusb();
1382 1.1 augustss ohci_hash_add_td(sc, setup);
1383 1.1 augustss if (len != 0)
1384 1.48 augustss ohci_hash_add_td(sc, data);
1385 1.1 augustss ohci_hash_add_td(sc, stat);
1386 1.39 augustss sed->ed.ed_tailp = LE(tail->physaddr);
1387 1.60 augustss opipe->tail.td = tail;
1388 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
1389 1.53 augustss if (xfer->timeout && !sc->sc_bus.use_polling) {
1390 1.53 augustss usb_timeout(ohci_timeout, xfer,
1391 1.53 augustss MS_TO_TICKS(xfer->timeout), xfer->timo_handle);
1392 1.15 augustss }
1393 1.1 augustss splx(s);
1394 1.1 augustss
1395 1.52 augustss #ifdef OHCI_DEBUG
1396 1.1 augustss if (ohcidebug > 5) {
1397 1.55 augustss usb_delay_ms(&sc->sc_bus, 5);
1398 1.41 augustss DPRINTF(("ohci_device_request: status=%x\n",
1399 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
1400 1.1 augustss ohci_dump_ed(sed);
1401 1.1 augustss ohci_dump_tds(setup);
1402 1.1 augustss }
1403 1.1 augustss #endif
1404 1.1 augustss
1405 1.1 augustss return (USBD_NORMAL_COMPLETION);
1406 1.1 augustss
1407 1.1 augustss bad3:
1408 1.1 augustss ohci_free_std(sc, tail);
1409 1.1 augustss bad2:
1410 1.1 augustss ohci_free_std(sc, stat);
1411 1.1 augustss bad1:
1412 1.53 augustss return (err);
1413 1.1 augustss }
1414 1.1 augustss
1415 1.1 augustss /*
1416 1.1 augustss * Add an ED to the schedule. Called at splusb().
1417 1.1 augustss */
1418 1.1 augustss void
1419 1.3 augustss ohci_add_ed(sed, head)
1420 1.1 augustss ohci_soft_ed_t *sed;
1421 1.1 augustss ohci_soft_ed_t *head;
1422 1.1 augustss {
1423 1.46 augustss SPLUSBCHECK;
1424 1.1 augustss sed->next = head->next;
1425 1.39 augustss sed->ed.ed_nexted = head->ed.ed_nexted;
1426 1.1 augustss head->next = sed;
1427 1.39 augustss head->ed.ed_nexted = LE(sed->physaddr);
1428 1.1 augustss }
1429 1.1 augustss
1430 1.1 augustss /*
1431 1.3 augustss * Remove an ED from the schedule. Called at splusb().
1432 1.3 augustss */
1433 1.3 augustss void
1434 1.3 augustss ohci_rem_ed(sed, head)
1435 1.3 augustss ohci_soft_ed_t *sed;
1436 1.3 augustss ohci_soft_ed_t *head;
1437 1.3 augustss {
1438 1.3 augustss ohci_soft_ed_t *p;
1439 1.3 augustss
1440 1.46 augustss SPLUSBCHECK;
1441 1.46 augustss
1442 1.3 augustss /* XXX */
1443 1.55 augustss for (p = head; p == NULL && p->next != sed; p = p->next)
1444 1.3 augustss ;
1445 1.55 augustss if (p == NULL)
1446 1.3 augustss panic("ohci_rem_ed: ED not found\n");
1447 1.3 augustss p->next = sed->next;
1448 1.39 augustss p->ed.ed_nexted = sed->ed.ed_nexted;
1449 1.3 augustss }
1450 1.3 augustss
1451 1.3 augustss /*
1452 1.1 augustss * When a transfer is completed the TD is added to the done queue by
1453 1.1 augustss * the host controller. This queue is the processed by software.
1454 1.1 augustss * Unfortunately the queue contains the physical address of the TD
1455 1.9 augustss * and we have no simple way to translate this back to a kernel address.
1456 1.1 augustss * To make the translation possible (and fast) we use a hash table of
1457 1.1 augustss * TDs currently in the schedule. The physical address is used as the
1458 1.1 augustss * hash value.
1459 1.1 augustss */
1460 1.1 augustss
1461 1.1 augustss #define HASH(a) (((a) >> 4) % OHCI_HASH_SIZE)
1462 1.1 augustss /* Called at splusb() */
1463 1.1 augustss void
1464 1.1 augustss ohci_hash_add_td(sc, std)
1465 1.1 augustss ohci_softc_t *sc;
1466 1.1 augustss ohci_soft_td_t *std;
1467 1.1 augustss {
1468 1.1 augustss int h = HASH(std->physaddr);
1469 1.1 augustss
1470 1.46 augustss SPLUSBCHECK;
1471 1.46 augustss
1472 1.1 augustss LIST_INSERT_HEAD(&sc->sc_hash_tds[h], std, hnext);
1473 1.1 augustss }
1474 1.1 augustss
1475 1.1 augustss /* Called at splusb() */
1476 1.1 augustss void
1477 1.1 augustss ohci_hash_rem_td(sc, std)
1478 1.1 augustss ohci_softc_t *sc;
1479 1.1 augustss ohci_soft_td_t *std;
1480 1.1 augustss {
1481 1.46 augustss SPLUSBCHECK;
1482 1.46 augustss
1483 1.1 augustss LIST_REMOVE(std, hnext);
1484 1.1 augustss }
1485 1.1 augustss
1486 1.1 augustss ohci_soft_td_t *
1487 1.1 augustss ohci_hash_find_td(sc, a)
1488 1.1 augustss ohci_softc_t *sc;
1489 1.1 augustss ohci_physaddr_t a;
1490 1.1 augustss {
1491 1.1 augustss int h = HASH(a);
1492 1.1 augustss ohci_soft_td_t *std;
1493 1.1 augustss
1494 1.1 augustss for (std = LIST_FIRST(&sc->sc_hash_tds[h]);
1495 1.53 augustss std != NULL;
1496 1.1 augustss std = LIST_NEXT(std, hnext))
1497 1.1 augustss if (std->physaddr == a)
1498 1.1 augustss return (std);
1499 1.1 augustss panic("ohci_hash_find_td: addr 0x%08lx not found\n", (u_long)a);
1500 1.1 augustss }
1501 1.1 augustss
1502 1.1 augustss void
1503 1.1 augustss ohci_timeout(addr)
1504 1.1 augustss void *addr;
1505 1.1 augustss {
1506 1.53 augustss usbd_xfer_handle xfer = addr;
1507 1.48 augustss int s;
1508 1.1 augustss
1509 1.53 augustss DPRINTF(("ohci_timeout: xfer=%p\n", xfer));
1510 1.45 augustss
1511 1.48 augustss s = splusb();
1512 1.53 augustss xfer->device->bus->intr_context++;
1513 1.54 augustss ohci_abort_xfer(xfer, USBD_TIMEOUT);
1514 1.53 augustss xfer->device->bus->intr_context--;
1515 1.48 augustss splx(s);
1516 1.1 augustss }
1517 1.1 augustss
1518 1.52 augustss #ifdef OHCI_DEBUG
1519 1.1 augustss void
1520 1.1 augustss ohci_dump_tds(std)
1521 1.1 augustss ohci_soft_td_t *std;
1522 1.1 augustss {
1523 1.1 augustss for (; std; std = std->nexttd)
1524 1.1 augustss ohci_dump_td(std);
1525 1.1 augustss }
1526 1.1 augustss
1527 1.1 augustss void
1528 1.1 augustss ohci_dump_td(std)
1529 1.1 augustss ohci_soft_td_t *std;
1530 1.1 augustss {
1531 1.41 augustss DPRINTF(("TD(%p) at %08lx: %b delay=%d ec=%d cc=%d\ncbp=0x%08lx "
1532 1.41 augustss "nexttd=0x%08lx be=0x%08lx\n",
1533 1.41 augustss std, (u_long)std->physaddr,
1534 1.41 augustss (int)LE(std->td.td_flags),
1535 1.41 augustss "\20\23R\24OUT\25IN\31TOG1\32SETTOGGLE",
1536 1.41 augustss OHCI_TD_GET_DI(LE(std->td.td_flags)),
1537 1.41 augustss OHCI_TD_GET_EC(LE(std->td.td_flags)),
1538 1.41 augustss OHCI_TD_GET_CC(LE(std->td.td_flags)),
1539 1.41 augustss (u_long)LE(std->td.td_cbp),
1540 1.41 augustss (u_long)LE(std->td.td_nexttd), (u_long)LE(std->td.td_be)));
1541 1.1 augustss }
1542 1.1 augustss
1543 1.1 augustss void
1544 1.1 augustss ohci_dump_ed(sed)
1545 1.1 augustss ohci_soft_ed_t *sed;
1546 1.1 augustss {
1547 1.41 augustss DPRINTF(("ED(%p) at %08lx: addr=%d endpt=%d maxp=%d %b\ntailp=0x%08lx "
1548 1.41 augustss "headp=%b nexted=0x%08lx\n",
1549 1.41 augustss sed, (u_long)sed->physaddr,
1550 1.41 augustss OHCI_ED_GET_FA(LE(sed->ed.ed_flags)),
1551 1.41 augustss OHCI_ED_GET_EN(LE(sed->ed.ed_flags)),
1552 1.41 augustss OHCI_ED_GET_MAXP(LE(sed->ed.ed_flags)),
1553 1.41 augustss (int)LE(sed->ed.ed_flags),
1554 1.41 augustss "\20\14OUT\15IN\16LOWSPEED\17SKIP\20ISO",
1555 1.41 augustss (u_long)LE(sed->ed.ed_tailp),
1556 1.52 augustss (u_long)LE(sed->ed.ed_headp),
1557 1.52 augustss "\20\1HALT\2CARRY",
1558 1.41 augustss (u_long)LE(sed->ed.ed_nexted)));
1559 1.1 augustss }
1560 1.1 augustss #endif
1561 1.1 augustss
1562 1.1 augustss usbd_status
1563 1.1 augustss ohci_open(pipe)
1564 1.1 augustss usbd_pipe_handle pipe;
1565 1.1 augustss {
1566 1.1 augustss usbd_device_handle dev = pipe->device;
1567 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1568 1.1 augustss usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
1569 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1570 1.1 augustss u_int8_t addr = dev->address;
1571 1.60 augustss u_int8_t xfertype = ed->bmAttributes & UE_XFERTYPE;
1572 1.1 augustss ohci_soft_ed_t *sed;
1573 1.1 augustss ohci_soft_td_t *std;
1574 1.60 augustss ohci_soft_itd_t *sitd;
1575 1.60 augustss ohci_physaddr_t tdphys;
1576 1.60 augustss u_int32_t fmt;
1577 1.53 augustss usbd_status err;
1578 1.1 augustss int s;
1579 1.1 augustss
1580 1.1 augustss DPRINTFN(1, ("ohci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
1581 1.1 augustss pipe, addr, ed->bEndpointAddress, sc->sc_addr));
1582 1.1 augustss if (addr == sc->sc_addr) {
1583 1.1 augustss switch (ed->bEndpointAddress) {
1584 1.1 augustss case USB_CONTROL_ENDPOINT:
1585 1.1 augustss pipe->methods = &ohci_root_ctrl_methods;
1586 1.1 augustss break;
1587 1.40 augustss case UE_DIR_IN | OHCI_INTR_ENDPT:
1588 1.1 augustss pipe->methods = &ohci_root_intr_methods;
1589 1.1 augustss break;
1590 1.1 augustss default:
1591 1.1 augustss return (USBD_INVAL);
1592 1.1 augustss }
1593 1.1 augustss } else {
1594 1.1 augustss sed = ohci_alloc_sed(sc);
1595 1.53 augustss if (sed == NULL)
1596 1.1 augustss goto bad0;
1597 1.1 augustss opipe->sed = sed;
1598 1.60 augustss if (xfertype == UE_ISOCHRONOUS) {
1599 1.60 augustss sitd = ohci_alloc_sitd(sc);
1600 1.60 augustss if (sitd == NULL) {
1601 1.60 augustss ohci_free_sitd(sc, sitd);
1602 1.60 augustss goto bad1;
1603 1.60 augustss }
1604 1.60 augustss opipe->tail.itd = sitd;
1605 1.60 augustss tdphys = LE(sitd->physaddr);
1606 1.60 augustss fmt = OHCI_ED_FORMAT_ISO;
1607 1.60 augustss } else {
1608 1.60 augustss std = ohci_alloc_std(sc);
1609 1.60 augustss if (std == NULL) {
1610 1.60 augustss ohci_free_std(sc, std);
1611 1.60 augustss goto bad1;
1612 1.60 augustss }
1613 1.60 augustss opipe->tail.td = std;
1614 1.60 augustss tdphys = LE(std->physaddr);
1615 1.60 augustss fmt = OHCI_ED_FORMAT_GEN;
1616 1.60 augustss }
1617 1.39 augustss sed->ed.ed_flags = LE(
1618 1.1 augustss OHCI_ED_SET_FA(addr) |
1619 1.1 augustss OHCI_ED_SET_EN(ed->bEndpointAddress) |
1620 1.1 augustss OHCI_ED_DIR_TD |
1621 1.60 augustss (dev->lowspeed ? OHCI_ED_SPEED : 0) | fmt |
1622 1.16 augustss OHCI_ED_SET_MAXP(UGETW(ed->wMaxPacketSize)));
1623 1.60 augustss sed->ed.ed_headp = sed->ed.ed_tailp = tdphys;
1624 1.1 augustss
1625 1.60 augustss switch (xfertype) {
1626 1.1 augustss case UE_CONTROL:
1627 1.1 augustss pipe->methods = &ohci_device_ctrl_methods;
1628 1.53 augustss err = usb_allocmem(&sc->sc_bus,
1629 1.53 augustss sizeof(usb_device_request_t),
1630 1.53 augustss 0, &opipe->u.ctl.reqdma);
1631 1.53 augustss if (err)
1632 1.1 augustss goto bad;
1633 1.1 augustss s = splusb();
1634 1.3 augustss ohci_add_ed(sed, sc->sc_ctrl_head);
1635 1.1 augustss splx(s);
1636 1.1 augustss break;
1637 1.1 augustss case UE_INTERRUPT:
1638 1.1 augustss pipe->methods = &ohci_device_intr_methods;
1639 1.1 augustss return (ohci_device_setintr(sc, opipe, ed->bInterval));
1640 1.1 augustss case UE_ISOCHRONOUS:
1641 1.60 augustss pipe->methods = &ohci_device_isoc_methods;
1642 1.60 augustss return (ohci_setup_isoc(pipe));
1643 1.1 augustss case UE_BULK:
1644 1.3 augustss pipe->methods = &ohci_device_bulk_methods;
1645 1.3 augustss s = splusb();
1646 1.3 augustss ohci_add_ed(sed, sc->sc_bulk_head);
1647 1.3 augustss splx(s);
1648 1.3 augustss break;
1649 1.1 augustss }
1650 1.1 augustss }
1651 1.1 augustss return (USBD_NORMAL_COMPLETION);
1652 1.1 augustss
1653 1.1 augustss bad:
1654 1.1 augustss ohci_free_std(sc, std);
1655 1.1 augustss bad1:
1656 1.1 augustss ohci_free_sed(sc, sed);
1657 1.1 augustss bad0:
1658 1.1 augustss return (USBD_NOMEM);
1659 1.1 augustss
1660 1.1 augustss }
1661 1.1 augustss
1662 1.1 augustss /*
1663 1.34 augustss * Close a reqular pipe.
1664 1.34 augustss * Assumes that there are no pending transactions.
1665 1.34 augustss */
1666 1.34 augustss void
1667 1.34 augustss ohci_close_pipe(pipe, head)
1668 1.34 augustss usbd_pipe_handle pipe;
1669 1.34 augustss ohci_soft_ed_t *head;
1670 1.34 augustss {
1671 1.34 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1672 1.34 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
1673 1.34 augustss ohci_soft_ed_t *sed = opipe->sed;
1674 1.34 augustss int s;
1675 1.34 augustss
1676 1.34 augustss s = splusb();
1677 1.34 augustss #ifdef DIAGNOSTIC
1678 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
1679 1.39 augustss if ((sed->ed.ed_tailp & LE(OHCI_TAILMASK)) !=
1680 1.39 augustss (sed->ed.ed_headp & LE(OHCI_TAILMASK))) {
1681 1.39 augustss ohci_physaddr_t td = sed->ed.ed_headp;
1682 1.34 augustss ohci_soft_td_t *std;
1683 1.34 augustss for (std = LIST_FIRST(&sc->sc_hash_tds[HASH(td)]);
1684 1.53 augustss std != NULL;
1685 1.34 augustss std = LIST_NEXT(std, hnext))
1686 1.34 augustss if (std->physaddr == td)
1687 1.34 augustss break;
1688 1.34 augustss printf("ohci_close_pipe: pipe not empty sed=%p hd=0x%x "
1689 1.34 augustss "tl=0x%x pipe=%p, std=%p\n", sed,
1690 1.39 augustss (int)LE(sed->ed.ed_headp), (int)LE(sed->ed.ed_tailp),
1691 1.34 augustss pipe, std);
1692 1.34 augustss usb_delay_ms(&sc->sc_bus, 2);
1693 1.39 augustss if ((sed->ed.ed_tailp & LE(OHCI_TAILMASK)) !=
1694 1.39 augustss (sed->ed.ed_headp & LE(OHCI_TAILMASK)))
1695 1.34 augustss printf("ohci_close_pipe: pipe still not empty\n");
1696 1.34 augustss }
1697 1.34 augustss #endif
1698 1.34 augustss ohci_rem_ed(sed, head);
1699 1.34 augustss splx(s);
1700 1.34 augustss ohci_free_sed(sc, opipe->sed);
1701 1.34 augustss }
1702 1.34 augustss
1703 1.34 augustss /*
1704 1.34 augustss * Abort a device request.
1705 1.34 augustss * If this routine is called at splusb() it guarantees that the request
1706 1.34 augustss * will be removed from the hardware scheduling and that the callback
1707 1.34 augustss * for it will be called with USBD_CANCELLED status.
1708 1.34 augustss * It's impossible to guarantee that the requested transfer will not
1709 1.34 augustss * have happened since the hardware runs concurrently.
1710 1.34 augustss * If the transaction has already happened we rely on the ordinary
1711 1.34 augustss * interrupt processing to process it.
1712 1.34 augustss */
1713 1.34 augustss void
1714 1.54 augustss ohci_abort_xfer(xfer, status)
1715 1.53 augustss usbd_xfer_handle xfer;
1716 1.38 augustss usbd_status status;
1717 1.34 augustss {
1718 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1719 1.34 augustss ohci_soft_ed_t *sed;
1720 1.34 augustss
1721 1.54 augustss DPRINTF(("ohci_abort_xfer: xfer=%p pipe=%p\n", xfer, opipe));
1722 1.34 augustss
1723 1.53 augustss xfer->status = status;
1724 1.34 augustss
1725 1.53 augustss usb_untimeout(ohci_timeout, xfer, xfer->timo_handle);
1726 1.34 augustss
1727 1.34 augustss sed = opipe->sed;
1728 1.54 augustss DPRINTFN(1,("ohci_abort_xfer: stop ed=%p\n", sed));
1729 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP); /* force hardware skip */
1730 1.34 augustss
1731 1.61 augustss #if 1
1732 1.53 augustss if (xfer->device->bus->intr_context) {
1733 1.44 augustss /* We have no process context, so we can't use tsleep(). */
1734 1.54 augustss timeout(ohci_abort_xfer_end, xfer, hz / USB_FRAMES_PER_SECOND);
1735 1.44 augustss } else {
1736 1.55 augustss #if defined(DIAGNOSTIC) && defined(__i386__) && defined(__FreeBSD__)
1737 1.55 augustss KASSERT(intr_nesting_level == 0,
1738 1.55 augustss ("ohci_abort_req in interrupt context"));
1739 1.55 augustss #endif
1740 1.38 augustss usb_delay_ms(opipe->pipe.device->bus, 1);
1741 1.54 augustss ohci_abort_xfer_end(xfer);
1742 1.38 augustss }
1743 1.61 augustss #else
1744 1.61 augustss delay(1000);
1745 1.61 augustss ohci_abort_xfer_end(xfer);
1746 1.61 augustss #endif
1747 1.38 augustss }
1748 1.38 augustss
1749 1.38 augustss void
1750 1.54 augustss ohci_abort_xfer_end(v)
1751 1.38 augustss void *v;
1752 1.38 augustss {
1753 1.53 augustss usbd_xfer_handle xfer = v;
1754 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1755 1.38 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
1756 1.38 augustss ohci_soft_ed_t *sed;
1757 1.38 augustss ohci_soft_td_t *p, *n;
1758 1.38 augustss int s;
1759 1.38 augustss
1760 1.38 augustss s = splusb();
1761 1.38 augustss
1762 1.53 augustss p = xfer->hcpriv;
1763 1.34 augustss #ifdef DIAGNOSTIC
1764 1.55 augustss if (p == NULL) {
1765 1.54 augustss printf("ohci_abort_xfer: hcpriv==0\n");
1766 1.38 augustss return;
1767 1.38 augustss }
1768 1.34 augustss #endif
1769 1.53 augustss for (; p->xfer == xfer; p = n) {
1770 1.38 augustss n = p->nexttd;
1771 1.38 augustss ohci_hash_rem_td(sc, p);
1772 1.38 augustss ohci_free_std(sc, p);
1773 1.34 augustss }
1774 1.34 augustss
1775 1.38 augustss sed = opipe->sed;
1776 1.54 augustss DPRINTFN(2,("ohci_abort_xfer: set hd=%x, tl=%x\n",
1777 1.39 augustss (int)LE(p->physaddr), (int)LE(sed->ed.ed_tailp)));
1778 1.39 augustss sed->ed.ed_headp = p->physaddr; /* unlink TDs */
1779 1.39 augustss sed->ed.ed_flags &= LE(~OHCI_ED_SKIP); /* remove hardware skip */
1780 1.38 augustss
1781 1.53 augustss usb_transfer_complete(xfer);
1782 1.38 augustss
1783 1.34 augustss splx(s);
1784 1.34 augustss }
1785 1.34 augustss
1786 1.34 augustss /*
1787 1.1 augustss * Data structures and routines to emulate the root hub.
1788 1.1 augustss */
1789 1.53 augustss static usb_device_descriptor_t ohci_devd = {
1790 1.1 augustss USB_DEVICE_DESCRIPTOR_SIZE,
1791 1.1 augustss UDESC_DEVICE, /* type */
1792 1.1 augustss {0x00, 0x01}, /* USB version */
1793 1.1 augustss UCLASS_HUB, /* class */
1794 1.1 augustss USUBCLASS_HUB, /* subclass */
1795 1.1 augustss 0, /* protocol */
1796 1.1 augustss 64, /* max packet */
1797 1.1 augustss {0},{0},{0x00,0x01}, /* device id */
1798 1.1 augustss 1,2,0, /* string indicies */
1799 1.1 augustss 1 /* # of configurations */
1800 1.1 augustss };
1801 1.1 augustss
1802 1.53 augustss static usb_config_descriptor_t ohci_confd = {
1803 1.1 augustss USB_CONFIG_DESCRIPTOR_SIZE,
1804 1.1 augustss UDESC_CONFIG,
1805 1.1 augustss {USB_CONFIG_DESCRIPTOR_SIZE +
1806 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE +
1807 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE},
1808 1.1 augustss 1,
1809 1.1 augustss 1,
1810 1.1 augustss 0,
1811 1.1 augustss UC_SELF_POWERED,
1812 1.1 augustss 0 /* max power */
1813 1.1 augustss };
1814 1.1 augustss
1815 1.53 augustss static usb_interface_descriptor_t ohci_ifcd = {
1816 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE,
1817 1.1 augustss UDESC_INTERFACE,
1818 1.1 augustss 0,
1819 1.1 augustss 0,
1820 1.1 augustss 1,
1821 1.1 augustss UCLASS_HUB,
1822 1.1 augustss USUBCLASS_HUB,
1823 1.1 augustss 0,
1824 1.1 augustss 0
1825 1.1 augustss };
1826 1.1 augustss
1827 1.53 augustss static usb_endpoint_descriptor_t ohci_endpd = {
1828 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE,
1829 1.1 augustss UDESC_ENDPOINT,
1830 1.40 augustss UE_DIR_IN | OHCI_INTR_ENDPT,
1831 1.1 augustss UE_INTERRUPT,
1832 1.1 augustss {8, 0}, /* max packet */
1833 1.1 augustss 255
1834 1.1 augustss };
1835 1.1 augustss
1836 1.53 augustss static usb_hub_descriptor_t ohci_hubd = {
1837 1.1 augustss USB_HUB_DESCRIPTOR_SIZE,
1838 1.1 augustss UDESC_HUB,
1839 1.1 augustss 0,
1840 1.1 augustss {0,0},
1841 1.1 augustss 0,
1842 1.1 augustss 0,
1843 1.1 augustss {0},
1844 1.1 augustss };
1845 1.1 augustss
1846 1.55 augustss static int
1847 1.1 augustss ohci_str(p, l, s)
1848 1.1 augustss usb_string_descriptor_t *p;
1849 1.1 augustss int l;
1850 1.1 augustss char *s;
1851 1.1 augustss {
1852 1.1 augustss int i;
1853 1.1 augustss
1854 1.1 augustss if (l == 0)
1855 1.1 augustss return (0);
1856 1.1 augustss p->bLength = 2 * strlen(s) + 2;
1857 1.1 augustss if (l == 1)
1858 1.1 augustss return (1);
1859 1.1 augustss p->bDescriptorType = UDESC_STRING;
1860 1.1 augustss l -= 2;
1861 1.1 augustss for (i = 0; s[i] && l > 1; i++, l -= 2)
1862 1.1 augustss USETW2(p->bString[i], 0, s[i]);
1863 1.1 augustss return (2*i+2);
1864 1.1 augustss }
1865 1.1 augustss
1866 1.1 augustss /*
1867 1.1 augustss * Simulate a hardware hub by handling all the necessary requests.
1868 1.1 augustss */
1869 1.55 augustss static usbd_status
1870 1.53 augustss ohci_root_ctrl_transfer(xfer)
1871 1.53 augustss usbd_xfer_handle xfer;
1872 1.1 augustss {
1873 1.53 augustss usbd_status err;
1874 1.17 augustss
1875 1.46 augustss /* Insert last in queue. */
1876 1.53 augustss err = usb_insert_transfer(xfer);
1877 1.53 augustss if (err)
1878 1.53 augustss return (err);
1879 1.46 augustss
1880 1.46 augustss /* Pipe isn't running, start first */
1881 1.53 augustss return (ohci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
1882 1.17 augustss }
1883 1.17 augustss
1884 1.55 augustss static usbd_status
1885 1.53 augustss ohci_root_ctrl_start(xfer)
1886 1.53 augustss usbd_xfer_handle xfer;
1887 1.17 augustss {
1888 1.53 augustss ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
1889 1.1 augustss usb_device_request_t *req;
1890 1.52 augustss void *buf = NULL;
1891 1.1 augustss int port, i;
1892 1.46 augustss int s, len, value, index, l, totlen = 0;
1893 1.1 augustss usb_port_status_t ps;
1894 1.1 augustss usb_hub_descriptor_t hubd;
1895 1.53 augustss usbd_status err;
1896 1.1 augustss u_int32_t v;
1897 1.1 augustss
1898 1.42 augustss #ifdef DIAGNOSTIC
1899 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST))
1900 1.1 augustss /* XXX panic */
1901 1.1 augustss return (USBD_INVAL);
1902 1.42 augustss #endif
1903 1.53 augustss req = &xfer->request;
1904 1.1 augustss
1905 1.1 augustss DPRINTFN(4,("ohci_root_ctrl_control type=0x%02x request=%02x\n",
1906 1.1 augustss req->bmRequestType, req->bRequest));
1907 1.1 augustss
1908 1.1 augustss len = UGETW(req->wLength);
1909 1.1 augustss value = UGETW(req->wValue);
1910 1.1 augustss index = UGETW(req->wIndex);
1911 1.43 augustss
1912 1.43 augustss if (len != 0)
1913 1.53 augustss buf = KERNADDR(&xfer->dmabuf);
1914 1.43 augustss
1915 1.1 augustss #define C(x,y) ((x) | ((y) << 8))
1916 1.1 augustss switch(C(req->bRequest, req->bmRequestType)) {
1917 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
1918 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
1919 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
1920 1.1 augustss /*
1921 1.15 augustss * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
1922 1.1 augustss * for the integrated root hub.
1923 1.1 augustss */
1924 1.1 augustss break;
1925 1.1 augustss case C(UR_GET_CONFIG, UT_READ_DEVICE):
1926 1.1 augustss if (len > 0) {
1927 1.1 augustss *(u_int8_t *)buf = sc->sc_conf;
1928 1.1 augustss totlen = 1;
1929 1.1 augustss }
1930 1.1 augustss break;
1931 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
1932 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_control wValue=0x%04x\n", value));
1933 1.1 augustss switch(value >> 8) {
1934 1.1 augustss case UDESC_DEVICE:
1935 1.1 augustss if ((value & 0xff) != 0) {
1936 1.53 augustss err = USBD_IOERROR;
1937 1.1 augustss goto ret;
1938 1.1 augustss }
1939 1.1 augustss totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
1940 1.29 augustss USETW(ohci_devd.idVendor, sc->sc_id_vendor);
1941 1.1 augustss memcpy(buf, &ohci_devd, l);
1942 1.1 augustss break;
1943 1.1 augustss case UDESC_CONFIG:
1944 1.1 augustss if ((value & 0xff) != 0) {
1945 1.53 augustss err = USBD_IOERROR;
1946 1.1 augustss goto ret;
1947 1.1 augustss }
1948 1.1 augustss totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
1949 1.1 augustss memcpy(buf, &ohci_confd, l);
1950 1.1 augustss buf = (char *)buf + l;
1951 1.1 augustss len -= l;
1952 1.1 augustss l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
1953 1.1 augustss totlen += l;
1954 1.1 augustss memcpy(buf, &ohci_ifcd, l);
1955 1.1 augustss buf = (char *)buf + l;
1956 1.1 augustss len -= l;
1957 1.1 augustss l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
1958 1.1 augustss totlen += l;
1959 1.1 augustss memcpy(buf, &ohci_endpd, l);
1960 1.1 augustss break;
1961 1.1 augustss case UDESC_STRING:
1962 1.1 augustss if (len == 0)
1963 1.1 augustss break;
1964 1.1 augustss *(u_int8_t *)buf = 0;
1965 1.1 augustss totlen = 1;
1966 1.1 augustss switch (value & 0xff) {
1967 1.1 augustss case 1: /* Vendor */
1968 1.1 augustss totlen = ohci_str(buf, len, sc->sc_vendor);
1969 1.1 augustss break;
1970 1.1 augustss case 2: /* Product */
1971 1.1 augustss totlen = ohci_str(buf, len, "OHCI root hub");
1972 1.1 augustss break;
1973 1.1 augustss }
1974 1.1 augustss break;
1975 1.1 augustss default:
1976 1.53 augustss err = USBD_IOERROR;
1977 1.1 augustss goto ret;
1978 1.1 augustss }
1979 1.1 augustss break;
1980 1.1 augustss case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
1981 1.1 augustss if (len > 0) {
1982 1.1 augustss *(u_int8_t *)buf = 0;
1983 1.1 augustss totlen = 1;
1984 1.1 augustss }
1985 1.1 augustss break;
1986 1.1 augustss case C(UR_GET_STATUS, UT_READ_DEVICE):
1987 1.1 augustss if (len > 1) {
1988 1.1 augustss USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
1989 1.1 augustss totlen = 2;
1990 1.1 augustss }
1991 1.1 augustss break;
1992 1.1 augustss case C(UR_GET_STATUS, UT_READ_INTERFACE):
1993 1.1 augustss case C(UR_GET_STATUS, UT_READ_ENDPOINT):
1994 1.1 augustss if (len > 1) {
1995 1.1 augustss USETW(((usb_status_t *)buf)->wStatus, 0);
1996 1.1 augustss totlen = 2;
1997 1.1 augustss }
1998 1.1 augustss break;
1999 1.1 augustss case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
2000 1.1 augustss if (value >= USB_MAX_DEVICES) {
2001 1.53 augustss err = USBD_IOERROR;
2002 1.1 augustss goto ret;
2003 1.1 augustss }
2004 1.1 augustss sc->sc_addr = value;
2005 1.1 augustss break;
2006 1.1 augustss case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
2007 1.1 augustss if (value != 0 && value != 1) {
2008 1.53 augustss err = USBD_IOERROR;
2009 1.1 augustss goto ret;
2010 1.1 augustss }
2011 1.1 augustss sc->sc_conf = value;
2012 1.1 augustss break;
2013 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
2014 1.1 augustss break;
2015 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
2016 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
2017 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
2018 1.53 augustss err = USBD_IOERROR;
2019 1.1 augustss goto ret;
2020 1.1 augustss case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
2021 1.1 augustss break;
2022 1.1 augustss case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
2023 1.1 augustss break;
2024 1.1 augustss /* Hub requests */
2025 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
2026 1.1 augustss break;
2027 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
2028 1.14 augustss DPRINTFN(8, ("ohci_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
2029 1.14 augustss "port=%d feature=%d\n",
2030 1.1 augustss index, value));
2031 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2032 1.53 augustss err = USBD_IOERROR;
2033 1.1 augustss goto ret;
2034 1.1 augustss }
2035 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
2036 1.1 augustss switch(value) {
2037 1.1 augustss case UHF_PORT_ENABLE:
2038 1.1 augustss OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS);
2039 1.1 augustss break;
2040 1.1 augustss case UHF_PORT_SUSPEND:
2041 1.1 augustss OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR);
2042 1.1 augustss break;
2043 1.1 augustss case UHF_PORT_POWER:
2044 1.1 augustss OWRITE4(sc, port, UPS_LOW_SPEED);
2045 1.1 augustss break;
2046 1.1 augustss case UHF_C_PORT_CONNECTION:
2047 1.1 augustss OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16);
2048 1.1 augustss break;
2049 1.1 augustss case UHF_C_PORT_ENABLE:
2050 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16);
2051 1.1 augustss break;
2052 1.1 augustss case UHF_C_PORT_SUSPEND:
2053 1.1 augustss OWRITE4(sc, port, UPS_C_SUSPEND << 16);
2054 1.1 augustss break;
2055 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
2056 1.1 augustss OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16);
2057 1.1 augustss break;
2058 1.1 augustss case UHF_C_PORT_RESET:
2059 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_RESET << 16);
2060 1.1 augustss break;
2061 1.1 augustss default:
2062 1.53 augustss err = USBD_IOERROR;
2063 1.1 augustss goto ret;
2064 1.1 augustss }
2065 1.1 augustss switch(value) {
2066 1.1 augustss case UHF_C_PORT_CONNECTION:
2067 1.1 augustss case UHF_C_PORT_ENABLE:
2068 1.1 augustss case UHF_C_PORT_SUSPEND:
2069 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
2070 1.1 augustss case UHF_C_PORT_RESET:
2071 1.1 augustss /* Enable RHSC interrupt if condition is cleared. */
2072 1.1 augustss if ((OREAD4(sc, port) >> 16) == 0)
2073 1.1 augustss ohci_rhsc_able(sc, 1);
2074 1.1 augustss break;
2075 1.1 augustss default:
2076 1.1 augustss break;
2077 1.1 augustss }
2078 1.1 augustss break;
2079 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
2080 1.1 augustss if (value != 0) {
2081 1.53 augustss err = USBD_IOERROR;
2082 1.1 augustss goto ret;
2083 1.1 augustss }
2084 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
2085 1.1 augustss hubd = ohci_hubd;
2086 1.1 augustss hubd.bNbrPorts = sc->sc_noport;
2087 1.15 augustss USETW(hubd.wHubCharacteristics,
2088 1.1 augustss (v & OHCI_NPS ? UHD_PWR_NO_SWITCH :
2089 1.1 augustss v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL)
2090 1.1 augustss /* XXX overcurrent */
2091 1.1 augustss );
2092 1.1 augustss hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v);
2093 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
2094 1.15 augustss for (i = 0, l = sc->sc_noport; l > 0; i++, l -= 8, v >>= 8)
2095 1.15 augustss hubd.DeviceRemovable[i++] = (u_int8_t)v;
2096 1.15 augustss hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i;
2097 1.1 augustss l = min(len, hubd.bDescLength);
2098 1.1 augustss totlen = l;
2099 1.1 augustss memcpy(buf, &hubd, l);
2100 1.1 augustss break;
2101 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
2102 1.1 augustss if (len != 4) {
2103 1.53 augustss err = USBD_IOERROR;
2104 1.1 augustss goto ret;
2105 1.1 augustss }
2106 1.1 augustss memset(buf, 0, len); /* ? XXX */
2107 1.1 augustss totlen = len;
2108 1.1 augustss break;
2109 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
2110 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: get port status i=%d\n",
2111 1.1 augustss index));
2112 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2113 1.53 augustss err = USBD_IOERROR;
2114 1.1 augustss goto ret;
2115 1.1 augustss }
2116 1.1 augustss if (len != 4) {
2117 1.53 augustss err = USBD_IOERROR;
2118 1.1 augustss goto ret;
2119 1.1 augustss }
2120 1.1 augustss v = OREAD4(sc, OHCI_RH_PORT_STATUS(index));
2121 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: port status=0x%04x\n",
2122 1.1 augustss v));
2123 1.1 augustss USETW(ps.wPortStatus, v);
2124 1.1 augustss USETW(ps.wPortChange, v >> 16);
2125 1.1 augustss l = min(len, sizeof ps);
2126 1.1 augustss memcpy(buf, &ps, l);
2127 1.1 augustss totlen = l;
2128 1.1 augustss break;
2129 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
2130 1.53 augustss err = USBD_IOERROR;
2131 1.1 augustss goto ret;
2132 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
2133 1.1 augustss break;
2134 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
2135 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2136 1.53 augustss err = USBD_IOERROR;
2137 1.1 augustss goto ret;
2138 1.1 augustss }
2139 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
2140 1.1 augustss switch(value) {
2141 1.1 augustss case UHF_PORT_ENABLE:
2142 1.1 augustss OWRITE4(sc, port, UPS_PORT_ENABLED);
2143 1.1 augustss break;
2144 1.1 augustss case UHF_PORT_SUSPEND:
2145 1.1 augustss OWRITE4(sc, port, UPS_SUSPEND);
2146 1.1 augustss break;
2147 1.1 augustss case UHF_PORT_RESET:
2148 1.14 augustss DPRINTFN(5,("ohci_root_ctrl_transfer: reset port %d\n",
2149 1.14 augustss index));
2150 1.1 augustss OWRITE4(sc, port, UPS_RESET);
2151 1.1 augustss for (i = 0; i < 10; i++) {
2152 1.20 augustss usb_delay_ms(&sc->sc_bus, 10);
2153 1.1 augustss if ((OREAD4(sc, port) & UPS_RESET) == 0)
2154 1.1 augustss break;
2155 1.1 augustss }
2156 1.1 augustss DPRINTFN(8,("ohci port %d reset, status = 0x%04x\n",
2157 1.1 augustss index, OREAD4(sc, port)));
2158 1.1 augustss break;
2159 1.1 augustss case UHF_PORT_POWER:
2160 1.14 augustss DPRINTFN(2,("ohci_root_ctrl_transfer: set port power "
2161 1.14 augustss "%d\n", index));
2162 1.1 augustss OWRITE4(sc, port, UPS_PORT_POWER);
2163 1.1 augustss break;
2164 1.1 augustss default:
2165 1.53 augustss err = USBD_IOERROR;
2166 1.1 augustss goto ret;
2167 1.1 augustss }
2168 1.1 augustss break;
2169 1.1 augustss default:
2170 1.53 augustss err = USBD_IOERROR;
2171 1.1 augustss goto ret;
2172 1.1 augustss }
2173 1.53 augustss xfer->actlen = totlen;
2174 1.53 augustss err = USBD_NORMAL_COMPLETION;
2175 1.1 augustss ret:
2176 1.53 augustss xfer->status = err;
2177 1.46 augustss s = splusb();
2178 1.53 augustss usb_transfer_complete(xfer);
2179 1.46 augustss splx(s);
2180 1.1 augustss return (USBD_IN_PROGRESS);
2181 1.1 augustss }
2182 1.1 augustss
2183 1.1 augustss /* Abort a root control request. */
2184 1.55 augustss static void
2185 1.53 augustss ohci_root_ctrl_abort(xfer)
2186 1.53 augustss usbd_xfer_handle xfer;
2187 1.1 augustss {
2188 1.9 augustss /* Nothing to do, all transfers are synchronous. */
2189 1.1 augustss }
2190 1.1 augustss
2191 1.1 augustss /* Close the root pipe. */
2192 1.55 augustss static void
2193 1.1 augustss ohci_root_ctrl_close(pipe)
2194 1.1 augustss usbd_pipe_handle pipe;
2195 1.1 augustss {
2196 1.1 augustss DPRINTF(("ohci_root_ctrl_close\n"));
2197 1.34 augustss /* Nothing to do. */
2198 1.1 augustss }
2199 1.1 augustss
2200 1.55 augustss static usbd_status
2201 1.53 augustss ohci_root_intr_transfer(xfer)
2202 1.53 augustss usbd_xfer_handle xfer;
2203 1.1 augustss {
2204 1.53 augustss usbd_status err;
2205 1.17 augustss
2206 1.46 augustss /* Insert last in queue. */
2207 1.53 augustss err = usb_insert_transfer(xfer);
2208 1.53 augustss if (err)
2209 1.53 augustss return (err);
2210 1.46 augustss
2211 1.46 augustss /* Pipe isn't running, start first */
2212 1.53 augustss return (ohci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2213 1.17 augustss }
2214 1.17 augustss
2215 1.55 augustss static usbd_status
2216 1.53 augustss ohci_root_intr_start(xfer)
2217 1.53 augustss usbd_xfer_handle xfer;
2218 1.17 augustss {
2219 1.53 augustss usbd_pipe_handle pipe = xfer->pipe;
2220 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2221 1.1 augustss
2222 1.53 augustss sc->sc_intrxfer = xfer;
2223 1.1 augustss
2224 1.1 augustss return (USBD_IN_PROGRESS);
2225 1.1 augustss }
2226 1.1 augustss
2227 1.3 augustss /* Abort a root interrupt request. */
2228 1.55 augustss static void
2229 1.53 augustss ohci_root_intr_abort(xfer)
2230 1.53 augustss usbd_xfer_handle xfer;
2231 1.1 augustss {
2232 1.53 augustss int s;
2233 1.53 augustss
2234 1.53 augustss if (xfer->pipe->intrxfer == xfer) {
2235 1.51 augustss DPRINTF(("ohci_root_intr_abort: remove\n"));
2236 1.53 augustss xfer->pipe->intrxfer = NULL;
2237 1.51 augustss }
2238 1.53 augustss xfer->status = USBD_CANCELLED;
2239 1.53 augustss s = splusb();
2240 1.53 augustss usb_transfer_complete(xfer);
2241 1.53 augustss splx(s);
2242 1.1 augustss }
2243 1.1 augustss
2244 1.1 augustss /* Close the root pipe. */
2245 1.55 augustss static void
2246 1.1 augustss ohci_root_intr_close(pipe)
2247 1.1 augustss usbd_pipe_handle pipe;
2248 1.1 augustss {
2249 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2250 1.1 augustss
2251 1.1 augustss DPRINTF(("ohci_root_intr_close\n"));
2252 1.34 augustss
2253 1.53 augustss sc->sc_intrxfer = NULL;
2254 1.1 augustss }
2255 1.1 augustss
2256 1.1 augustss /************************/
2257 1.1 augustss
2258 1.55 augustss static usbd_status
2259 1.53 augustss ohci_device_ctrl_transfer(xfer)
2260 1.53 augustss usbd_xfer_handle xfer;
2261 1.1 augustss {
2262 1.53 augustss usbd_status err;
2263 1.17 augustss
2264 1.46 augustss /* Insert last in queue. */
2265 1.53 augustss err = usb_insert_transfer(xfer);
2266 1.53 augustss if (err)
2267 1.53 augustss return (err);
2268 1.46 augustss
2269 1.46 augustss /* Pipe isn't running, start first */
2270 1.53 augustss return (ohci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2271 1.17 augustss }
2272 1.17 augustss
2273 1.55 augustss static usbd_status
2274 1.53 augustss ohci_device_ctrl_start(xfer)
2275 1.53 augustss usbd_xfer_handle xfer;
2276 1.17 augustss {
2277 1.53 augustss ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
2278 1.53 augustss usbd_status err;
2279 1.1 augustss
2280 1.42 augustss #ifdef DIAGNOSTIC
2281 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST)) {
2282 1.1 augustss /* XXX panic */
2283 1.1 augustss printf("ohci_device_ctrl_transfer: not a request\n");
2284 1.1 augustss return (USBD_INVAL);
2285 1.1 augustss }
2286 1.42 augustss #endif
2287 1.1 augustss
2288 1.53 augustss err = ohci_device_request(xfer);
2289 1.53 augustss if (err)
2290 1.53 augustss return (err);
2291 1.1 augustss
2292 1.6 augustss if (sc->sc_bus.use_polling)
2293 1.53 augustss ohci_waitintr(sc, xfer);
2294 1.1 augustss return (USBD_IN_PROGRESS);
2295 1.1 augustss }
2296 1.1 augustss
2297 1.1 augustss /* Abort a device control request. */
2298 1.55 augustss static void
2299 1.53 augustss ohci_device_ctrl_abort(xfer)
2300 1.53 augustss usbd_xfer_handle xfer;
2301 1.1 augustss {
2302 1.53 augustss DPRINTF(("ohci_device_ctrl_abort: xfer=%p\n", xfer));
2303 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2304 1.1 augustss }
2305 1.1 augustss
2306 1.1 augustss /* Close a device control pipe. */
2307 1.55 augustss static void
2308 1.1 augustss ohci_device_ctrl_close(pipe)
2309 1.1 augustss usbd_pipe_handle pipe;
2310 1.1 augustss {
2311 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2312 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2313 1.1 augustss
2314 1.34 augustss DPRINTF(("ohci_device_ctrl_close: pipe=%p\n", pipe));
2315 1.34 augustss ohci_close_pipe(pipe, sc->sc_ctrl_head);
2316 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2317 1.3 augustss }
2318 1.3 augustss
2319 1.3 augustss /************************/
2320 1.37 augustss
2321 1.55 augustss static void
2322 1.37 augustss ohci_device_clear_toggle(pipe)
2323 1.37 augustss usbd_pipe_handle pipe;
2324 1.37 augustss {
2325 1.37 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2326 1.37 augustss
2327 1.39 augustss opipe->sed->ed.ed_tailp &= LE(~OHCI_TOGGLECARRY);
2328 1.37 augustss }
2329 1.37 augustss
2330 1.55 augustss static void
2331 1.37 augustss ohci_noop(pipe)
2332 1.37 augustss usbd_pipe_handle pipe;
2333 1.37 augustss {
2334 1.37 augustss }
2335 1.3 augustss
2336 1.55 augustss static usbd_status
2337 1.53 augustss ohci_device_bulk_transfer(xfer)
2338 1.53 augustss usbd_xfer_handle xfer;
2339 1.3 augustss {
2340 1.53 augustss usbd_status err;
2341 1.17 augustss
2342 1.46 augustss /* Insert last in queue. */
2343 1.53 augustss err = usb_insert_transfer(xfer);
2344 1.53 augustss if (err)
2345 1.53 augustss return (err);
2346 1.46 augustss
2347 1.46 augustss /* Pipe isn't running, start first */
2348 1.53 augustss return (ohci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2349 1.17 augustss }
2350 1.17 augustss
2351 1.55 augustss static usbd_status
2352 1.53 augustss ohci_device_bulk_start(xfer)
2353 1.53 augustss usbd_xfer_handle xfer;
2354 1.17 augustss {
2355 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2356 1.3 augustss usbd_device_handle dev = opipe->pipe.device;
2357 1.3 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2358 1.3 augustss int addr = dev->address;
2359 1.48 augustss ohci_soft_td_t *data, *tail, *tdp;
2360 1.3 augustss ohci_soft_ed_t *sed;
2361 1.40 augustss int s, len, isread, endpt;
2362 1.53 augustss usbd_status err;
2363 1.3 augustss
2364 1.34 augustss #ifdef DIAGNOSTIC
2365 1.53 augustss if (xfer->rqflags & URQ_REQUEST) {
2366 1.3 augustss /* XXX panic */
2367 1.34 augustss printf("ohci_device_bulk_start: a request\n");
2368 1.3 augustss return (USBD_INVAL);
2369 1.3 augustss }
2370 1.34 augustss #endif
2371 1.3 augustss
2372 1.53 augustss len = xfer->length;
2373 1.53 augustss endpt = xfer->pipe->endpoint->edesc->bEndpointAddress;
2374 1.40 augustss isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2375 1.3 augustss sed = opipe->sed;
2376 1.3 augustss
2377 1.53 augustss DPRINTFN(4,("ohci_device_bulk_start: xfer=%p len=%d isread=%d "
2378 1.53 augustss "flags=%d endpt=%d\n", xfer, len, isread, xfer->flags,
2379 1.40 augustss endpt));
2380 1.34 augustss
2381 1.32 augustss opipe->u.bulk.isread = isread;
2382 1.3 augustss opipe->u.bulk.length = len;
2383 1.3 augustss
2384 1.3 augustss /* Update device address */
2385 1.39 augustss sed->ed.ed_flags = LE(
2386 1.39 augustss (LE(sed->ed.ed_flags) & ~OHCI_ED_ADDRMASK) |
2387 1.16 augustss OHCI_ED_SET_FA(addr));
2388 1.3 augustss
2389 1.48 augustss /* Allocate a chain of new TDs (including a new tail). */
2390 1.60 augustss data = opipe->tail.td;
2391 1.61 augustss err = ohci_alloc_std_chain(opipe, sc, len, isread, xfer->flags,
2392 1.53 augustss &xfer->dmabuf, data, &tail);
2393 1.53 augustss if (err)
2394 1.53 augustss return (err);
2395 1.48 augustss
2396 1.53 augustss tail->xfer = NULL;
2397 1.53 augustss xfer->hcpriv = data;
2398 1.3 augustss
2399 1.34 augustss DPRINTFN(4,("ohci_device_bulk_start: ed_flags=0x%08x td_flags=0x%08x "
2400 1.34 augustss "td_cbp=0x%08x td_be=0x%08x\n",
2401 1.48 augustss (int)LE(sed->ed.ed_flags), (int)LE(data->td.td_flags),
2402 1.48 augustss (int)LE(data->td.td_cbp), (int)LE(data->td.td_be)));
2403 1.34 augustss
2404 1.52 augustss #ifdef OHCI_DEBUG
2405 1.34 augustss if (ohcidebug > 4) {
2406 1.34 augustss ohci_dump_ed(sed);
2407 1.48 augustss ohci_dump_tds(data);
2408 1.34 augustss }
2409 1.34 augustss #endif
2410 1.34 augustss
2411 1.3 augustss /* Insert ED in schedule */
2412 1.3 augustss s = splusb();
2413 1.48 augustss for (tdp = data; tdp != tail; tdp = tdp->nexttd) {
2414 1.53 augustss tdp->xfer = xfer;
2415 1.48 augustss ohci_hash_add_td(sc, tdp);
2416 1.48 augustss }
2417 1.39 augustss sed->ed.ed_tailp = LE(tail->physaddr);
2418 1.60 augustss opipe->tail.td = tail;
2419 1.39 augustss sed->ed.ed_flags &= LE(~OHCI_ED_SKIP);
2420 1.3 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF);
2421 1.53 augustss if (xfer->timeout && !sc->sc_bus.use_polling) {
2422 1.53 augustss usb_timeout(ohci_timeout, xfer,
2423 1.53 augustss MS_TO_TICKS(xfer->timeout), xfer->timo_handle);
2424 1.15 augustss }
2425 1.34 augustss
2426 1.52 augustss #if 0
2427 1.52 augustss /* This goes wrong if we are too slow. */
2428 1.34 augustss if (ohcidebug > 5) {
2429 1.55 augustss usb_delay_ms(&sc->sc_bus, 5);
2430 1.41 augustss DPRINTF(("ohci_device_intr_transfer: status=%x\n",
2431 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
2432 1.34 augustss ohci_dump_ed(sed);
2433 1.48 augustss ohci_dump_tds(data);
2434 1.34 augustss }
2435 1.34 augustss #endif
2436 1.34 augustss
2437 1.3 augustss splx(s);
2438 1.3 augustss
2439 1.3 augustss return (USBD_IN_PROGRESS);
2440 1.3 augustss }
2441 1.3 augustss
2442 1.55 augustss static void
2443 1.53 augustss ohci_device_bulk_abort(xfer)
2444 1.53 augustss usbd_xfer_handle xfer;
2445 1.3 augustss {
2446 1.53 augustss DPRINTF(("ohci_device_bulk_abort: xfer=%p\n", xfer));
2447 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2448 1.3 augustss }
2449 1.3 augustss
2450 1.34 augustss /*
2451 1.34 augustss * Close a device bulk pipe.
2452 1.34 augustss */
2453 1.55 augustss static void
2454 1.3 augustss ohci_device_bulk_close(pipe)
2455 1.3 augustss usbd_pipe_handle pipe;
2456 1.3 augustss {
2457 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2458 1.34 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2459 1.3 augustss
2460 1.34 augustss DPRINTF(("ohci_device_bulk_close: pipe=%p\n", pipe));
2461 1.34 augustss ohci_close_pipe(pipe, sc->sc_bulk_head);
2462 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2463 1.1 augustss }
2464 1.1 augustss
2465 1.1 augustss /************************/
2466 1.1 augustss
2467 1.55 augustss static usbd_status
2468 1.53 augustss ohci_device_intr_transfer(xfer)
2469 1.53 augustss usbd_xfer_handle xfer;
2470 1.17 augustss {
2471 1.53 augustss usbd_status err;
2472 1.17 augustss
2473 1.46 augustss /* Insert last in queue. */
2474 1.53 augustss err = usb_insert_transfer(xfer);
2475 1.53 augustss if (err)
2476 1.53 augustss return (err);
2477 1.46 augustss
2478 1.46 augustss /* Pipe isn't running, start first */
2479 1.53 augustss return (ohci_device_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2480 1.17 augustss }
2481 1.17 augustss
2482 1.55 augustss static usbd_status
2483 1.53 augustss ohci_device_intr_start(xfer)
2484 1.53 augustss usbd_xfer_handle xfer;
2485 1.1 augustss {
2486 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2487 1.1 augustss usbd_device_handle dev = opipe->pipe.device;
2488 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2489 1.1 augustss ohci_soft_ed_t *sed = opipe->sed;
2490 1.48 augustss ohci_soft_td_t *data, *tail;
2491 1.1 augustss int len;
2492 1.1 augustss int s;
2493 1.1 augustss
2494 1.53 augustss DPRINTFN(3, ("ohci_device_intr_transfer: xfer=%p len=%d "
2495 1.14 augustss "flags=%d priv=%p\n",
2496 1.53 augustss xfer, xfer->length, xfer->flags, xfer->priv));
2497 1.1 augustss
2498 1.42 augustss #ifdef DIAGNOSTIC
2499 1.53 augustss if (xfer->rqflags & URQ_REQUEST)
2500 1.1 augustss panic("ohci_device_intr_transfer: a request\n");
2501 1.42 augustss #endif
2502 1.1 augustss
2503 1.53 augustss len = xfer->length;
2504 1.1 augustss
2505 1.60 augustss data = opipe->tail.td;
2506 1.1 augustss tail = ohci_alloc_std(sc);
2507 1.55 augustss if (tail == NULL)
2508 1.43 augustss return (USBD_NOMEM);
2509 1.53 augustss tail->xfer = NULL;
2510 1.1 augustss
2511 1.48 augustss data->td.td_flags = LE(
2512 1.16 augustss OHCI_TD_IN | OHCI_TD_NOCC |
2513 1.16 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
2514 1.53 augustss if (xfer->flags & USBD_SHORT_XFER_OK)
2515 1.48 augustss data->td.td_flags |= LE(OHCI_TD_R);
2516 1.53 augustss data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
2517 1.48 augustss data->nexttd = tail;
2518 1.48 augustss data->td.td_nexttd = LE(tail->physaddr);
2519 1.48 augustss data->td.td_be = LE(LE(data->td.td_cbp) + len - 1);
2520 1.48 augustss data->len = len;
2521 1.53 augustss data->xfer = xfer;
2522 1.48 augustss data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
2523 1.53 augustss xfer->hcpriv = data;
2524 1.1 augustss
2525 1.52 augustss #ifdef OHCI_DEBUG
2526 1.1 augustss if (ohcidebug > 5) {
2527 1.41 augustss DPRINTF(("ohci_device_intr_transfer:\n"));
2528 1.1 augustss ohci_dump_ed(sed);
2529 1.48 augustss ohci_dump_tds(data);
2530 1.1 augustss }
2531 1.1 augustss #endif
2532 1.1 augustss
2533 1.1 augustss /* Insert ED in schedule */
2534 1.1 augustss s = splusb();
2535 1.48 augustss ohci_hash_add_td(sc, data);
2536 1.39 augustss sed->ed.ed_tailp = LE(tail->physaddr);
2537 1.60 augustss opipe->tail.td = tail;
2538 1.39 augustss sed->ed.ed_flags &= LE(~OHCI_ED_SKIP);
2539 1.1 augustss
2540 1.52 augustss #if 0
2541 1.52 augustss /*
2542 1.52 augustss * This goes horribly wrong, printing thousands of descriptors,
2543 1.52 augustss * because false references are followed due to the fact that the
2544 1.52 augustss * TD is gone.
2545 1.52 augustss */
2546 1.1 augustss if (ohcidebug > 5) {
2547 1.55 augustss usb_delay_ms(&sc->sc_bus, 5);
2548 1.41 augustss DPRINTF(("ohci_device_intr_transfer: status=%x\n",
2549 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
2550 1.1 augustss ohci_dump_ed(sed);
2551 1.48 augustss ohci_dump_tds(data);
2552 1.1 augustss }
2553 1.1 augustss #endif
2554 1.26 augustss splx(s);
2555 1.1 augustss
2556 1.1 augustss return (USBD_IN_PROGRESS);
2557 1.1 augustss }
2558 1.1 augustss
2559 1.1 augustss /* Abort a device control request. */
2560 1.55 augustss static void
2561 1.53 augustss ohci_device_intr_abort(xfer)
2562 1.53 augustss usbd_xfer_handle xfer;
2563 1.1 augustss {
2564 1.53 augustss if (xfer->pipe->intrxfer == xfer) {
2565 1.1 augustss DPRINTF(("ohci_device_intr_abort: remove\n"));
2566 1.55 augustss xfer->pipe->intrxfer = NULL;
2567 1.1 augustss }
2568 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2569 1.1 augustss }
2570 1.1 augustss
2571 1.1 augustss /* Close a device interrupt pipe. */
2572 1.55 augustss static void
2573 1.1 augustss ohci_device_intr_close(pipe)
2574 1.1 augustss usbd_pipe_handle pipe;
2575 1.1 augustss {
2576 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2577 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2578 1.1 augustss int nslots = opipe->u.intr.nslots;
2579 1.1 augustss int pos = opipe->u.intr.pos;
2580 1.1 augustss int j;
2581 1.1 augustss ohci_soft_ed_t *p, *sed = opipe->sed;
2582 1.1 augustss int s;
2583 1.1 augustss
2584 1.1 augustss DPRINTFN(1,("ohci_device_intr_close: pipe=%p nslots=%d pos=%d\n",
2585 1.1 augustss pipe, nslots, pos));
2586 1.1 augustss s = splusb();
2587 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
2588 1.39 augustss if ((sed->ed.ed_tailp & LE(OHCI_TAILMASK)) !=
2589 1.39 augustss (sed->ed.ed_headp & LE(OHCI_TAILMASK)))
2590 1.20 augustss usb_delay_ms(&sc->sc_bus, 2);
2591 1.1 augustss
2592 1.1 augustss for (p = sc->sc_eds[pos]; p && p->next != sed; p = p->next)
2593 1.1 augustss ;
2594 1.53 augustss #ifdef DIAGNOSTIC
2595 1.53 augustss if (p == NULL)
2596 1.1 augustss panic("ohci_device_intr_close: ED not found\n");
2597 1.53 augustss #endif
2598 1.1 augustss p->next = sed->next;
2599 1.39 augustss p->ed.ed_nexted = sed->ed.ed_nexted;
2600 1.1 augustss splx(s);
2601 1.1 augustss
2602 1.1 augustss for (j = 0; j < nslots; j++)
2603 1.31 wrstuden --sc->sc_bws[(pos * nslots + j) % OHCI_NO_INTRS];
2604 1.1 augustss
2605 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2606 1.1 augustss ohci_free_sed(sc, opipe->sed);
2607 1.1 augustss }
2608 1.1 augustss
2609 1.55 augustss static usbd_status
2610 1.1 augustss ohci_device_setintr(sc, opipe, ival)
2611 1.1 augustss ohci_softc_t *sc;
2612 1.1 augustss struct ohci_pipe *opipe;
2613 1.1 augustss int ival;
2614 1.1 augustss {
2615 1.1 augustss int i, j, s, best;
2616 1.1 augustss u_int npoll, slow, shigh, nslots;
2617 1.1 augustss u_int bestbw, bw;
2618 1.1 augustss ohci_soft_ed_t *hsed, *sed = opipe->sed;
2619 1.1 augustss
2620 1.1 augustss DPRINTFN(2, ("ohci_setintr: pipe=%p\n", opipe));
2621 1.1 augustss if (ival == 0) {
2622 1.1 augustss printf("ohci_setintr: 0 interval\n");
2623 1.1 augustss return (USBD_INVAL);
2624 1.1 augustss }
2625 1.1 augustss
2626 1.1 augustss npoll = OHCI_NO_INTRS;
2627 1.1 augustss while (npoll > ival)
2628 1.1 augustss npoll /= 2;
2629 1.1 augustss DPRINTFN(2, ("ohci_setintr: ival=%d npoll=%d\n", ival, npoll));
2630 1.1 augustss
2631 1.1 augustss /*
2632 1.1 augustss * We now know which level in the tree the ED must go into.
2633 1.1 augustss * Figure out which slot has most bandwidth left over.
2634 1.1 augustss * Slots to examine:
2635 1.1 augustss * npoll
2636 1.1 augustss * 1 0
2637 1.1 augustss * 2 1 2
2638 1.1 augustss * 4 3 4 5 6
2639 1.1 augustss * 8 7 8 9 10 11 12 13 14
2640 1.1 augustss * N (N-1) .. (N-1+N-1)
2641 1.1 augustss */
2642 1.1 augustss slow = npoll-1;
2643 1.1 augustss shigh = slow + npoll;
2644 1.1 augustss nslots = OHCI_NO_INTRS / npoll;
2645 1.1 augustss for (best = i = slow, bestbw = ~0; i < shigh; i++) {
2646 1.1 augustss bw = 0;
2647 1.1 augustss for (j = 0; j < nslots; j++)
2648 1.28 augustss bw += sc->sc_bws[(i * nslots + j) % OHCI_NO_INTRS];
2649 1.1 augustss if (bw < bestbw) {
2650 1.1 augustss best = i;
2651 1.1 augustss bestbw = bw;
2652 1.1 augustss }
2653 1.1 augustss }
2654 1.1 augustss DPRINTFN(2, ("ohci_setintr: best=%d(%d..%d) bestbw=%d\n",
2655 1.1 augustss best, slow, shigh, bestbw));
2656 1.1 augustss
2657 1.1 augustss s = splusb();
2658 1.1 augustss hsed = sc->sc_eds[best];
2659 1.1 augustss sed->next = hsed->next;
2660 1.39 augustss sed->ed.ed_nexted = hsed->ed.ed_nexted;
2661 1.1 augustss hsed->next = sed;
2662 1.39 augustss hsed->ed.ed_nexted = LE(sed->physaddr);
2663 1.1 augustss splx(s);
2664 1.1 augustss
2665 1.1 augustss for (j = 0; j < nslots; j++)
2666 1.28 augustss ++sc->sc_bws[(best * nslots + j) % OHCI_NO_INTRS];
2667 1.1 augustss opipe->u.intr.nslots = nslots;
2668 1.1 augustss opipe->u.intr.pos = best;
2669 1.1 augustss
2670 1.1 augustss DPRINTFN(5, ("ohci_setintr: returns %p\n", opipe));
2671 1.1 augustss return (USBD_NORMAL_COMPLETION);
2672 1.60 augustss }
2673 1.60 augustss
2674 1.60 augustss /***********************/
2675 1.60 augustss
2676 1.60 augustss usbd_status
2677 1.60 augustss ohci_device_isoc_transfer(xfer)
2678 1.60 augustss usbd_xfer_handle xfer;
2679 1.60 augustss {
2680 1.60 augustss usbd_status err;
2681 1.60 augustss
2682 1.60 augustss DPRINTFN(5,("ohci_device_isoc_transfer: xfer=%p\n", xfer));
2683 1.60 augustss
2684 1.60 augustss /* Put it on our queue, */
2685 1.60 augustss err = usb_insert_transfer(xfer);
2686 1.60 augustss
2687 1.60 augustss /* bail out on error, */
2688 1.60 augustss if (err && err != USBD_IN_PROGRESS)
2689 1.60 augustss return (err);
2690 1.60 augustss
2691 1.60 augustss /* XXX should check inuse here */
2692 1.60 augustss
2693 1.60 augustss /* insert into schedule, */
2694 1.60 augustss ohci_device_isoc_enter(xfer);
2695 1.60 augustss
2696 1.60 augustss /* and put on interrupt list if the pipe wasn't running */
2697 1.60 augustss if (!err)
2698 1.60 augustss ohci_device_isoc_start(SIMPLEQ_FIRST(&xfer->pipe->queue));
2699 1.60 augustss
2700 1.60 augustss return (err);
2701 1.60 augustss }
2702 1.60 augustss
2703 1.60 augustss void
2704 1.60 augustss ohci_device_isoc_enter(xfer)
2705 1.60 augustss usbd_xfer_handle xfer;
2706 1.60 augustss {
2707 1.61 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2708 1.61 augustss usbd_device_handle dev = opipe->pipe.device;
2709 1.61 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2710 1.61 augustss ohci_soft_ed_t *sed = opipe->sed;
2711 1.61 augustss struct iso *iso = &opipe->u.iso;
2712 1.61 augustss ohci_soft_itd_t *sitd, *nsitd;
2713 1.61 augustss ohci_physaddr_t buf, offs;
2714 1.61 augustss int i, ncur, nframes;
2715 1.61 augustss int ncross;
2716 1.61 augustss int s;
2717 1.61 augustss
2718 1.61 augustss s = splusb();
2719 1.61 augustss sitd = opipe->tail.itd;
2720 1.61 augustss buf = DMAADDR(&xfer->dmabuf);
2721 1.61 augustss sitd->itd.itd_bp0 = LE(buf & OHCI_ITD_PAGE_MASK);
2722 1.61 augustss nframes = xfer->nframes;
2723 1.61 augustss offs = buf & OHCI_ITD_OFFSET_MASK;
2724 1.61 augustss for (i = ncur = 0; i < nframes; i++, ncur++) {
2725 1.61 augustss if (ncur == OHCI_ITD_NOFFSET || /* all offsets used */
2726 1.61 augustss ncross > 1) { /* too many page crossings */
2727 1.61 augustss
2728 1.61 augustss nsitd = ohci_alloc_sitd(sc);
2729 1.61 augustss if (nsitd == NULL) {
2730 1.61 augustss /* XXX what now? */
2731 1.61 augustss return;
2732 1.61 augustss }
2733 1.61 augustss sitd->nextitd = nsitd;
2734 1.61 augustss sitd->itd.itd_nextitd = LE(nsitd->physaddr);
2735 1.61 augustss sitd->itd.itd_flags = LE(
2736 1.61 augustss OHCI_ITD_NOCC |
2737 1.61 augustss OHCI_ITD_SET_SF(iso->next) |
2738 1.61 augustss OHCI_ITD_NOINTR |
2739 1.61 augustss OHCI_ITD_SET_FC(OHCI_ITD_NOFFSET));
2740 1.61 augustss sitd->itd.itd_be = LE(LE(sitd->itd.itd_bp0) + offs - 1);
2741 1.61 augustss nsitd->itd.itd_bp0 = LE((buf + offs) & OHCI_ITD_PAGE_MASK);
2742 1.61 augustss sitd = nsitd;
2743 1.61 augustss iso->next = iso->next + ncur;
2744 1.61 augustss ncur = 0;
2745 1.61 augustss ncross = 0;
2746 1.61 augustss }
2747 1.61 augustss /* XXX byte order */
2748 1.61 augustss sitd->itd.itd_offset[i] =
2749 1.61 augustss offs | (ncross == 1 ? OHCI_ITD_PAGE_SELECT : 0);
2750 1.61 augustss offs += xfer->frlengths[i];
2751 1.61 augustss /* XXX update ncross */
2752 1.61 augustss }
2753 1.61 augustss nsitd = ohci_alloc_sitd(sc);
2754 1.61 augustss if (nsitd == NULL) {
2755 1.61 augustss /* XXX what now? */
2756 1.61 augustss return;
2757 1.61 augustss }
2758 1.61 augustss sitd->nextitd = nsitd;
2759 1.61 augustss sitd->itd.itd_nextitd = LE(nsitd->physaddr);
2760 1.61 augustss sitd->itd.itd_flags = LE(
2761 1.61 augustss OHCI_ITD_NOCC |
2762 1.61 augustss OHCI_ITD_SET_SF(iso->next) |
2763 1.61 augustss OHCI_ITD_SET_DI(0) |
2764 1.61 augustss OHCI_ITD_SET_FC(ncur));
2765 1.61 augustss sitd->itd.itd_be = LE(LE(sitd->itd.itd_bp0) + offs - 1);
2766 1.61 augustss iso->next = iso->next + ncur;
2767 1.61 augustss
2768 1.61 augustss opipe->tail.itd = nsitd;
2769 1.61 augustss sed->ed.ed_tailp = LE(nsitd->physaddr);
2770 1.61 augustss /* XXX update ED */
2771 1.61 augustss splx(s);
2772 1.60 augustss }
2773 1.60 augustss
2774 1.60 augustss usbd_status
2775 1.60 augustss ohci_device_isoc_start(xfer)
2776 1.60 augustss usbd_xfer_handle xfer;
2777 1.60 augustss {
2778 1.60 augustss printf("ohci_device_isoc_start: not implemented\n");
2779 1.60 augustss return (USBD_INVAL);
2780 1.60 augustss }
2781 1.60 augustss
2782 1.60 augustss void
2783 1.60 augustss ohci_device_isoc_abort(xfer)
2784 1.60 augustss usbd_xfer_handle xfer;
2785 1.60 augustss {
2786 1.60 augustss }
2787 1.60 augustss
2788 1.60 augustss void
2789 1.60 augustss ohci_device_isoc_done(xfer)
2790 1.60 augustss usbd_xfer_handle xfer;
2791 1.60 augustss {
2792 1.60 augustss printf("ohci_device_isoc_done: not implemented\n");
2793 1.60 augustss }
2794 1.60 augustss
2795 1.60 augustss usbd_status
2796 1.60 augustss ohci_setup_isoc(pipe)
2797 1.60 augustss usbd_pipe_handle pipe;
2798 1.60 augustss {
2799 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2800 1.60 augustss struct iso *iso = &opipe->u.iso;
2801 1.60 augustss
2802 1.60 augustss iso->next = -1;
2803 1.60 augustss iso->inuse = 0;
2804 1.60 augustss
2805 1.60 augustss return (USBD_NORMAL_COMPLETION);
2806 1.60 augustss }
2807 1.60 augustss
2808 1.60 augustss void
2809 1.60 augustss ohci_device_isoc_close(pipe)
2810 1.60 augustss usbd_pipe_handle pipe;
2811 1.60 augustss {
2812 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2813 1.60 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2814 1.60 augustss
2815 1.60 augustss DPRINTF(("ohci_device_isoc_close: pipe=%p\n", pipe));
2816 1.60 augustss ohci_close_pipe(pipe, sc->sc_isoc_head);
2817 1.60 augustss ohci_free_sitd(sc, opipe->tail.itd);
2818 1.1 augustss }
2819