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