ohci.c revision 1.63 1 1.63 augustss /* $NetBSD: ohci.c,v 1.63 2000/01/18 20:23:42 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.1 augustss
1614 1.1 augustss DPRINTFN(1, ("ohci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
1615 1.1 augustss pipe, addr, ed->bEndpointAddress, sc->sc_addr));
1616 1.1 augustss if (addr == sc->sc_addr) {
1617 1.1 augustss switch (ed->bEndpointAddress) {
1618 1.1 augustss case USB_CONTROL_ENDPOINT:
1619 1.1 augustss pipe->methods = &ohci_root_ctrl_methods;
1620 1.1 augustss break;
1621 1.40 augustss case UE_DIR_IN | OHCI_INTR_ENDPT:
1622 1.1 augustss pipe->methods = &ohci_root_intr_methods;
1623 1.1 augustss break;
1624 1.1 augustss default:
1625 1.1 augustss return (USBD_INVAL);
1626 1.1 augustss }
1627 1.1 augustss } else {
1628 1.1 augustss sed = ohci_alloc_sed(sc);
1629 1.53 augustss if (sed == NULL)
1630 1.1 augustss goto bad0;
1631 1.1 augustss opipe->sed = sed;
1632 1.60 augustss if (xfertype == UE_ISOCHRONOUS) {
1633 1.60 augustss sitd = ohci_alloc_sitd(sc);
1634 1.60 augustss if (sitd == NULL) {
1635 1.60 augustss ohci_free_sitd(sc, sitd);
1636 1.60 augustss goto bad1;
1637 1.60 augustss }
1638 1.60 augustss opipe->tail.itd = sitd;
1639 1.60 augustss tdphys = LE(sitd->physaddr);
1640 1.60 augustss fmt = OHCI_ED_FORMAT_ISO;
1641 1.60 augustss } else {
1642 1.60 augustss std = ohci_alloc_std(sc);
1643 1.60 augustss if (std == NULL) {
1644 1.60 augustss ohci_free_std(sc, std);
1645 1.60 augustss goto bad1;
1646 1.60 augustss }
1647 1.60 augustss opipe->tail.td = std;
1648 1.60 augustss tdphys = LE(std->physaddr);
1649 1.60 augustss fmt = OHCI_ED_FORMAT_GEN;
1650 1.60 augustss }
1651 1.39 augustss sed->ed.ed_flags = LE(
1652 1.1 augustss OHCI_ED_SET_FA(addr) |
1653 1.1 augustss OHCI_ED_SET_EN(ed->bEndpointAddress) |
1654 1.1 augustss OHCI_ED_DIR_TD |
1655 1.60 augustss (dev->lowspeed ? OHCI_ED_SPEED : 0) | fmt |
1656 1.16 augustss OHCI_ED_SET_MAXP(UGETW(ed->wMaxPacketSize)));
1657 1.60 augustss sed->ed.ed_headp = sed->ed.ed_tailp = tdphys;
1658 1.1 augustss
1659 1.60 augustss switch (xfertype) {
1660 1.1 augustss case UE_CONTROL:
1661 1.1 augustss pipe->methods = &ohci_device_ctrl_methods;
1662 1.53 augustss err = usb_allocmem(&sc->sc_bus,
1663 1.53 augustss sizeof(usb_device_request_t),
1664 1.53 augustss 0, &opipe->u.ctl.reqdma);
1665 1.53 augustss if (err)
1666 1.1 augustss goto bad;
1667 1.1 augustss s = splusb();
1668 1.3 augustss ohci_add_ed(sed, sc->sc_ctrl_head);
1669 1.1 augustss splx(s);
1670 1.1 augustss break;
1671 1.1 augustss case UE_INTERRUPT:
1672 1.1 augustss pipe->methods = &ohci_device_intr_methods;
1673 1.1 augustss return (ohci_device_setintr(sc, opipe, ed->bInterval));
1674 1.1 augustss case UE_ISOCHRONOUS:
1675 1.60 augustss pipe->methods = &ohci_device_isoc_methods;
1676 1.60 augustss return (ohci_setup_isoc(pipe));
1677 1.1 augustss case UE_BULK:
1678 1.3 augustss pipe->methods = &ohci_device_bulk_methods;
1679 1.3 augustss s = splusb();
1680 1.3 augustss ohci_add_ed(sed, sc->sc_bulk_head);
1681 1.3 augustss splx(s);
1682 1.3 augustss break;
1683 1.1 augustss }
1684 1.1 augustss }
1685 1.1 augustss return (USBD_NORMAL_COMPLETION);
1686 1.1 augustss
1687 1.1 augustss bad:
1688 1.1 augustss ohci_free_std(sc, std);
1689 1.1 augustss bad1:
1690 1.1 augustss ohci_free_sed(sc, sed);
1691 1.1 augustss bad0:
1692 1.1 augustss return (USBD_NOMEM);
1693 1.1 augustss
1694 1.1 augustss }
1695 1.1 augustss
1696 1.1 augustss /*
1697 1.34 augustss * Close a reqular pipe.
1698 1.34 augustss * Assumes that there are no pending transactions.
1699 1.34 augustss */
1700 1.34 augustss void
1701 1.34 augustss ohci_close_pipe(pipe, head)
1702 1.34 augustss usbd_pipe_handle pipe;
1703 1.34 augustss ohci_soft_ed_t *head;
1704 1.34 augustss {
1705 1.34 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1706 1.34 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
1707 1.34 augustss ohci_soft_ed_t *sed = opipe->sed;
1708 1.34 augustss int s;
1709 1.34 augustss
1710 1.34 augustss s = splusb();
1711 1.34 augustss #ifdef DIAGNOSTIC
1712 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
1713 1.39 augustss if ((sed->ed.ed_tailp & LE(OHCI_TAILMASK)) !=
1714 1.39 augustss (sed->ed.ed_headp & LE(OHCI_TAILMASK))) {
1715 1.39 augustss ohci_physaddr_t td = sed->ed.ed_headp;
1716 1.34 augustss ohci_soft_td_t *std;
1717 1.34 augustss for (std = LIST_FIRST(&sc->sc_hash_tds[HASH(td)]);
1718 1.53 augustss std != NULL;
1719 1.34 augustss std = LIST_NEXT(std, hnext))
1720 1.34 augustss if (std->physaddr == td)
1721 1.34 augustss break;
1722 1.34 augustss printf("ohci_close_pipe: pipe not empty sed=%p hd=0x%x "
1723 1.34 augustss "tl=0x%x pipe=%p, std=%p\n", sed,
1724 1.39 augustss (int)LE(sed->ed.ed_headp), (int)LE(sed->ed.ed_tailp),
1725 1.34 augustss pipe, std);
1726 1.34 augustss usb_delay_ms(&sc->sc_bus, 2);
1727 1.39 augustss if ((sed->ed.ed_tailp & LE(OHCI_TAILMASK)) !=
1728 1.39 augustss (sed->ed.ed_headp & LE(OHCI_TAILMASK)))
1729 1.34 augustss printf("ohci_close_pipe: pipe still not empty\n");
1730 1.34 augustss }
1731 1.34 augustss #endif
1732 1.34 augustss ohci_rem_ed(sed, head);
1733 1.34 augustss splx(s);
1734 1.34 augustss ohci_free_sed(sc, opipe->sed);
1735 1.34 augustss }
1736 1.34 augustss
1737 1.34 augustss /*
1738 1.34 augustss * Abort a device request.
1739 1.34 augustss * If this routine is called at splusb() it guarantees that the request
1740 1.34 augustss * will be removed from the hardware scheduling and that the callback
1741 1.34 augustss * for it will be called with USBD_CANCELLED status.
1742 1.34 augustss * It's impossible to guarantee that the requested transfer will not
1743 1.34 augustss * have happened since the hardware runs concurrently.
1744 1.34 augustss * If the transaction has already happened we rely on the ordinary
1745 1.34 augustss * interrupt processing to process it.
1746 1.34 augustss */
1747 1.34 augustss void
1748 1.54 augustss ohci_abort_xfer(xfer, status)
1749 1.53 augustss usbd_xfer_handle xfer;
1750 1.38 augustss usbd_status status;
1751 1.34 augustss {
1752 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1753 1.34 augustss ohci_soft_ed_t *sed;
1754 1.34 augustss
1755 1.54 augustss DPRINTF(("ohci_abort_xfer: xfer=%p pipe=%p\n", xfer, opipe));
1756 1.34 augustss
1757 1.53 augustss xfer->status = status;
1758 1.34 augustss
1759 1.53 augustss usb_untimeout(ohci_timeout, xfer, xfer->timo_handle);
1760 1.34 augustss
1761 1.34 augustss sed = opipe->sed;
1762 1.54 augustss DPRINTFN(1,("ohci_abort_xfer: stop ed=%p\n", sed));
1763 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP); /* force hardware skip */
1764 1.34 augustss
1765 1.61 augustss #if 1
1766 1.53 augustss if (xfer->device->bus->intr_context) {
1767 1.44 augustss /* We have no process context, so we can't use tsleep(). */
1768 1.54 augustss timeout(ohci_abort_xfer_end, xfer, hz / USB_FRAMES_PER_SECOND);
1769 1.44 augustss } else {
1770 1.55 augustss #if defined(DIAGNOSTIC) && defined(__i386__) && defined(__FreeBSD__)
1771 1.55 augustss KASSERT(intr_nesting_level == 0,
1772 1.55 augustss ("ohci_abort_req in interrupt context"));
1773 1.55 augustss #endif
1774 1.38 augustss usb_delay_ms(opipe->pipe.device->bus, 1);
1775 1.54 augustss ohci_abort_xfer_end(xfer);
1776 1.38 augustss }
1777 1.61 augustss #else
1778 1.61 augustss delay(1000);
1779 1.61 augustss ohci_abort_xfer_end(xfer);
1780 1.61 augustss #endif
1781 1.38 augustss }
1782 1.38 augustss
1783 1.38 augustss void
1784 1.54 augustss ohci_abort_xfer_end(v)
1785 1.38 augustss void *v;
1786 1.38 augustss {
1787 1.53 augustss usbd_xfer_handle xfer = v;
1788 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1789 1.38 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
1790 1.38 augustss ohci_soft_ed_t *sed;
1791 1.38 augustss ohci_soft_td_t *p, *n;
1792 1.38 augustss int s;
1793 1.38 augustss
1794 1.38 augustss s = splusb();
1795 1.38 augustss
1796 1.53 augustss p = xfer->hcpriv;
1797 1.34 augustss #ifdef DIAGNOSTIC
1798 1.55 augustss if (p == NULL) {
1799 1.54 augustss printf("ohci_abort_xfer: hcpriv==0\n");
1800 1.38 augustss return;
1801 1.38 augustss }
1802 1.34 augustss #endif
1803 1.53 augustss for (; p->xfer == xfer; p = n) {
1804 1.38 augustss n = p->nexttd;
1805 1.38 augustss ohci_hash_rem_td(sc, p);
1806 1.38 augustss ohci_free_std(sc, p);
1807 1.34 augustss }
1808 1.34 augustss
1809 1.38 augustss sed = opipe->sed;
1810 1.54 augustss DPRINTFN(2,("ohci_abort_xfer: set hd=%x, tl=%x\n",
1811 1.39 augustss (int)LE(p->physaddr), (int)LE(sed->ed.ed_tailp)));
1812 1.39 augustss sed->ed.ed_headp = p->physaddr; /* unlink TDs */
1813 1.39 augustss sed->ed.ed_flags &= LE(~OHCI_ED_SKIP); /* remove hardware skip */
1814 1.38 augustss
1815 1.53 augustss usb_transfer_complete(xfer);
1816 1.38 augustss
1817 1.34 augustss splx(s);
1818 1.34 augustss }
1819 1.34 augustss
1820 1.34 augustss /*
1821 1.1 augustss * Data structures and routines to emulate the root hub.
1822 1.1 augustss */
1823 1.53 augustss static usb_device_descriptor_t ohci_devd = {
1824 1.1 augustss USB_DEVICE_DESCRIPTOR_SIZE,
1825 1.1 augustss UDESC_DEVICE, /* type */
1826 1.1 augustss {0x00, 0x01}, /* USB version */
1827 1.1 augustss UCLASS_HUB, /* class */
1828 1.1 augustss USUBCLASS_HUB, /* subclass */
1829 1.1 augustss 0, /* protocol */
1830 1.1 augustss 64, /* max packet */
1831 1.1 augustss {0},{0},{0x00,0x01}, /* device id */
1832 1.1 augustss 1,2,0, /* string indicies */
1833 1.1 augustss 1 /* # of configurations */
1834 1.1 augustss };
1835 1.1 augustss
1836 1.53 augustss static usb_config_descriptor_t ohci_confd = {
1837 1.1 augustss USB_CONFIG_DESCRIPTOR_SIZE,
1838 1.1 augustss UDESC_CONFIG,
1839 1.1 augustss {USB_CONFIG_DESCRIPTOR_SIZE +
1840 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE +
1841 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE},
1842 1.1 augustss 1,
1843 1.1 augustss 1,
1844 1.1 augustss 0,
1845 1.1 augustss UC_SELF_POWERED,
1846 1.1 augustss 0 /* max power */
1847 1.1 augustss };
1848 1.1 augustss
1849 1.53 augustss static usb_interface_descriptor_t ohci_ifcd = {
1850 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE,
1851 1.1 augustss UDESC_INTERFACE,
1852 1.1 augustss 0,
1853 1.1 augustss 0,
1854 1.1 augustss 1,
1855 1.1 augustss UCLASS_HUB,
1856 1.1 augustss USUBCLASS_HUB,
1857 1.1 augustss 0,
1858 1.1 augustss 0
1859 1.1 augustss };
1860 1.1 augustss
1861 1.53 augustss static usb_endpoint_descriptor_t ohci_endpd = {
1862 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE,
1863 1.1 augustss UDESC_ENDPOINT,
1864 1.40 augustss UE_DIR_IN | OHCI_INTR_ENDPT,
1865 1.1 augustss UE_INTERRUPT,
1866 1.1 augustss {8, 0}, /* max packet */
1867 1.1 augustss 255
1868 1.1 augustss };
1869 1.1 augustss
1870 1.53 augustss static usb_hub_descriptor_t ohci_hubd = {
1871 1.1 augustss USB_HUB_DESCRIPTOR_SIZE,
1872 1.1 augustss UDESC_HUB,
1873 1.1 augustss 0,
1874 1.1 augustss {0,0},
1875 1.1 augustss 0,
1876 1.1 augustss 0,
1877 1.1 augustss {0},
1878 1.1 augustss };
1879 1.1 augustss
1880 1.55 augustss static int
1881 1.1 augustss ohci_str(p, l, s)
1882 1.1 augustss usb_string_descriptor_t *p;
1883 1.1 augustss int l;
1884 1.1 augustss char *s;
1885 1.1 augustss {
1886 1.1 augustss int i;
1887 1.1 augustss
1888 1.1 augustss if (l == 0)
1889 1.1 augustss return (0);
1890 1.1 augustss p->bLength = 2 * strlen(s) + 2;
1891 1.1 augustss if (l == 1)
1892 1.1 augustss return (1);
1893 1.1 augustss p->bDescriptorType = UDESC_STRING;
1894 1.1 augustss l -= 2;
1895 1.1 augustss for (i = 0; s[i] && l > 1; i++, l -= 2)
1896 1.1 augustss USETW2(p->bString[i], 0, s[i]);
1897 1.1 augustss return (2*i+2);
1898 1.1 augustss }
1899 1.1 augustss
1900 1.1 augustss /*
1901 1.1 augustss * Simulate a hardware hub by handling all the necessary requests.
1902 1.1 augustss */
1903 1.55 augustss static usbd_status
1904 1.53 augustss ohci_root_ctrl_transfer(xfer)
1905 1.53 augustss usbd_xfer_handle xfer;
1906 1.1 augustss {
1907 1.53 augustss usbd_status err;
1908 1.17 augustss
1909 1.46 augustss /* Insert last in queue. */
1910 1.53 augustss err = usb_insert_transfer(xfer);
1911 1.53 augustss if (err)
1912 1.53 augustss return (err);
1913 1.46 augustss
1914 1.46 augustss /* Pipe isn't running, start first */
1915 1.53 augustss return (ohci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
1916 1.17 augustss }
1917 1.17 augustss
1918 1.55 augustss static usbd_status
1919 1.53 augustss ohci_root_ctrl_start(xfer)
1920 1.53 augustss usbd_xfer_handle xfer;
1921 1.17 augustss {
1922 1.53 augustss ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
1923 1.1 augustss usb_device_request_t *req;
1924 1.52 augustss void *buf = NULL;
1925 1.1 augustss int port, i;
1926 1.46 augustss int s, len, value, index, l, totlen = 0;
1927 1.1 augustss usb_port_status_t ps;
1928 1.1 augustss usb_hub_descriptor_t hubd;
1929 1.53 augustss usbd_status err;
1930 1.1 augustss u_int32_t v;
1931 1.1 augustss
1932 1.42 augustss #ifdef DIAGNOSTIC
1933 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST))
1934 1.1 augustss /* XXX panic */
1935 1.1 augustss return (USBD_INVAL);
1936 1.42 augustss #endif
1937 1.53 augustss req = &xfer->request;
1938 1.1 augustss
1939 1.1 augustss DPRINTFN(4,("ohci_root_ctrl_control type=0x%02x request=%02x\n",
1940 1.1 augustss req->bmRequestType, req->bRequest));
1941 1.1 augustss
1942 1.1 augustss len = UGETW(req->wLength);
1943 1.1 augustss value = UGETW(req->wValue);
1944 1.1 augustss index = UGETW(req->wIndex);
1945 1.43 augustss
1946 1.43 augustss if (len != 0)
1947 1.53 augustss buf = KERNADDR(&xfer->dmabuf);
1948 1.43 augustss
1949 1.1 augustss #define C(x,y) ((x) | ((y) << 8))
1950 1.1 augustss switch(C(req->bRequest, req->bmRequestType)) {
1951 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
1952 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
1953 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
1954 1.1 augustss /*
1955 1.15 augustss * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
1956 1.1 augustss * for the integrated root hub.
1957 1.1 augustss */
1958 1.1 augustss break;
1959 1.1 augustss case C(UR_GET_CONFIG, UT_READ_DEVICE):
1960 1.1 augustss if (len > 0) {
1961 1.1 augustss *(u_int8_t *)buf = sc->sc_conf;
1962 1.1 augustss totlen = 1;
1963 1.1 augustss }
1964 1.1 augustss break;
1965 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
1966 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_control wValue=0x%04x\n", value));
1967 1.1 augustss switch(value >> 8) {
1968 1.1 augustss case UDESC_DEVICE:
1969 1.1 augustss if ((value & 0xff) != 0) {
1970 1.53 augustss err = USBD_IOERROR;
1971 1.1 augustss goto ret;
1972 1.1 augustss }
1973 1.1 augustss totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
1974 1.29 augustss USETW(ohci_devd.idVendor, sc->sc_id_vendor);
1975 1.1 augustss memcpy(buf, &ohci_devd, l);
1976 1.1 augustss break;
1977 1.1 augustss case UDESC_CONFIG:
1978 1.1 augustss if ((value & 0xff) != 0) {
1979 1.53 augustss err = USBD_IOERROR;
1980 1.1 augustss goto ret;
1981 1.1 augustss }
1982 1.1 augustss totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
1983 1.1 augustss memcpy(buf, &ohci_confd, l);
1984 1.1 augustss buf = (char *)buf + l;
1985 1.1 augustss len -= l;
1986 1.1 augustss l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
1987 1.1 augustss totlen += l;
1988 1.1 augustss memcpy(buf, &ohci_ifcd, l);
1989 1.1 augustss buf = (char *)buf + l;
1990 1.1 augustss len -= l;
1991 1.1 augustss l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
1992 1.1 augustss totlen += l;
1993 1.1 augustss memcpy(buf, &ohci_endpd, l);
1994 1.1 augustss break;
1995 1.1 augustss case UDESC_STRING:
1996 1.1 augustss if (len == 0)
1997 1.1 augustss break;
1998 1.1 augustss *(u_int8_t *)buf = 0;
1999 1.1 augustss totlen = 1;
2000 1.1 augustss switch (value & 0xff) {
2001 1.1 augustss case 1: /* Vendor */
2002 1.1 augustss totlen = ohci_str(buf, len, sc->sc_vendor);
2003 1.1 augustss break;
2004 1.1 augustss case 2: /* Product */
2005 1.1 augustss totlen = ohci_str(buf, len, "OHCI root hub");
2006 1.1 augustss break;
2007 1.1 augustss }
2008 1.1 augustss break;
2009 1.1 augustss default:
2010 1.53 augustss err = USBD_IOERROR;
2011 1.1 augustss goto ret;
2012 1.1 augustss }
2013 1.1 augustss break;
2014 1.1 augustss case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
2015 1.1 augustss if (len > 0) {
2016 1.1 augustss *(u_int8_t *)buf = 0;
2017 1.1 augustss totlen = 1;
2018 1.1 augustss }
2019 1.1 augustss break;
2020 1.1 augustss case C(UR_GET_STATUS, UT_READ_DEVICE):
2021 1.1 augustss if (len > 1) {
2022 1.1 augustss USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
2023 1.1 augustss totlen = 2;
2024 1.1 augustss }
2025 1.1 augustss break;
2026 1.1 augustss case C(UR_GET_STATUS, UT_READ_INTERFACE):
2027 1.1 augustss case C(UR_GET_STATUS, UT_READ_ENDPOINT):
2028 1.1 augustss if (len > 1) {
2029 1.1 augustss USETW(((usb_status_t *)buf)->wStatus, 0);
2030 1.1 augustss totlen = 2;
2031 1.1 augustss }
2032 1.1 augustss break;
2033 1.1 augustss case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
2034 1.1 augustss if (value >= USB_MAX_DEVICES) {
2035 1.53 augustss err = USBD_IOERROR;
2036 1.1 augustss goto ret;
2037 1.1 augustss }
2038 1.1 augustss sc->sc_addr = value;
2039 1.1 augustss break;
2040 1.1 augustss case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
2041 1.1 augustss if (value != 0 && value != 1) {
2042 1.53 augustss err = USBD_IOERROR;
2043 1.1 augustss goto ret;
2044 1.1 augustss }
2045 1.1 augustss sc->sc_conf = value;
2046 1.1 augustss break;
2047 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
2048 1.1 augustss break;
2049 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
2050 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
2051 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
2052 1.53 augustss err = USBD_IOERROR;
2053 1.1 augustss goto ret;
2054 1.1 augustss case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
2055 1.1 augustss break;
2056 1.1 augustss case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
2057 1.1 augustss break;
2058 1.1 augustss /* Hub requests */
2059 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
2060 1.1 augustss break;
2061 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
2062 1.14 augustss DPRINTFN(8, ("ohci_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
2063 1.14 augustss "port=%d feature=%d\n",
2064 1.1 augustss index, value));
2065 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2066 1.53 augustss err = USBD_IOERROR;
2067 1.1 augustss goto ret;
2068 1.1 augustss }
2069 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
2070 1.1 augustss switch(value) {
2071 1.1 augustss case UHF_PORT_ENABLE:
2072 1.1 augustss OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS);
2073 1.1 augustss break;
2074 1.1 augustss case UHF_PORT_SUSPEND:
2075 1.1 augustss OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR);
2076 1.1 augustss break;
2077 1.1 augustss case UHF_PORT_POWER:
2078 1.1 augustss OWRITE4(sc, port, UPS_LOW_SPEED);
2079 1.1 augustss break;
2080 1.1 augustss case UHF_C_PORT_CONNECTION:
2081 1.1 augustss OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16);
2082 1.1 augustss break;
2083 1.1 augustss case UHF_C_PORT_ENABLE:
2084 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16);
2085 1.1 augustss break;
2086 1.1 augustss case UHF_C_PORT_SUSPEND:
2087 1.1 augustss OWRITE4(sc, port, UPS_C_SUSPEND << 16);
2088 1.1 augustss break;
2089 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
2090 1.1 augustss OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16);
2091 1.1 augustss break;
2092 1.1 augustss case UHF_C_PORT_RESET:
2093 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_RESET << 16);
2094 1.1 augustss break;
2095 1.1 augustss default:
2096 1.53 augustss err = USBD_IOERROR;
2097 1.1 augustss goto ret;
2098 1.1 augustss }
2099 1.1 augustss switch(value) {
2100 1.1 augustss case UHF_C_PORT_CONNECTION:
2101 1.1 augustss case UHF_C_PORT_ENABLE:
2102 1.1 augustss case UHF_C_PORT_SUSPEND:
2103 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
2104 1.1 augustss case UHF_C_PORT_RESET:
2105 1.1 augustss /* Enable RHSC interrupt if condition is cleared. */
2106 1.1 augustss if ((OREAD4(sc, port) >> 16) == 0)
2107 1.1 augustss ohci_rhsc_able(sc, 1);
2108 1.1 augustss break;
2109 1.1 augustss default:
2110 1.1 augustss break;
2111 1.1 augustss }
2112 1.1 augustss break;
2113 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
2114 1.1 augustss if (value != 0) {
2115 1.53 augustss err = USBD_IOERROR;
2116 1.1 augustss goto ret;
2117 1.1 augustss }
2118 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
2119 1.1 augustss hubd = ohci_hubd;
2120 1.1 augustss hubd.bNbrPorts = sc->sc_noport;
2121 1.15 augustss USETW(hubd.wHubCharacteristics,
2122 1.1 augustss (v & OHCI_NPS ? UHD_PWR_NO_SWITCH :
2123 1.1 augustss v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL)
2124 1.1 augustss /* XXX overcurrent */
2125 1.1 augustss );
2126 1.1 augustss hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v);
2127 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
2128 1.15 augustss for (i = 0, l = sc->sc_noport; l > 0; i++, l -= 8, v >>= 8)
2129 1.15 augustss hubd.DeviceRemovable[i++] = (u_int8_t)v;
2130 1.15 augustss hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i;
2131 1.1 augustss l = min(len, hubd.bDescLength);
2132 1.1 augustss totlen = l;
2133 1.1 augustss memcpy(buf, &hubd, l);
2134 1.1 augustss break;
2135 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
2136 1.1 augustss if (len != 4) {
2137 1.53 augustss err = USBD_IOERROR;
2138 1.1 augustss goto ret;
2139 1.1 augustss }
2140 1.1 augustss memset(buf, 0, len); /* ? XXX */
2141 1.1 augustss totlen = len;
2142 1.1 augustss break;
2143 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
2144 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: get port status i=%d\n",
2145 1.1 augustss index));
2146 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2147 1.53 augustss err = USBD_IOERROR;
2148 1.1 augustss goto ret;
2149 1.1 augustss }
2150 1.1 augustss if (len != 4) {
2151 1.53 augustss err = USBD_IOERROR;
2152 1.1 augustss goto ret;
2153 1.1 augustss }
2154 1.1 augustss v = OREAD4(sc, OHCI_RH_PORT_STATUS(index));
2155 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: port status=0x%04x\n",
2156 1.1 augustss v));
2157 1.1 augustss USETW(ps.wPortStatus, v);
2158 1.1 augustss USETW(ps.wPortChange, v >> 16);
2159 1.1 augustss l = min(len, sizeof ps);
2160 1.1 augustss memcpy(buf, &ps, l);
2161 1.1 augustss totlen = l;
2162 1.1 augustss break;
2163 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
2164 1.53 augustss err = USBD_IOERROR;
2165 1.1 augustss goto ret;
2166 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
2167 1.1 augustss break;
2168 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
2169 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2170 1.53 augustss err = USBD_IOERROR;
2171 1.1 augustss goto ret;
2172 1.1 augustss }
2173 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
2174 1.1 augustss switch(value) {
2175 1.1 augustss case UHF_PORT_ENABLE:
2176 1.1 augustss OWRITE4(sc, port, UPS_PORT_ENABLED);
2177 1.1 augustss break;
2178 1.1 augustss case UHF_PORT_SUSPEND:
2179 1.1 augustss OWRITE4(sc, port, UPS_SUSPEND);
2180 1.1 augustss break;
2181 1.1 augustss case UHF_PORT_RESET:
2182 1.14 augustss DPRINTFN(5,("ohci_root_ctrl_transfer: reset port %d\n",
2183 1.14 augustss index));
2184 1.1 augustss OWRITE4(sc, port, UPS_RESET);
2185 1.1 augustss for (i = 0; i < 10; i++) {
2186 1.20 augustss usb_delay_ms(&sc->sc_bus, 10);
2187 1.1 augustss if ((OREAD4(sc, port) & UPS_RESET) == 0)
2188 1.1 augustss break;
2189 1.1 augustss }
2190 1.1 augustss DPRINTFN(8,("ohci port %d reset, status = 0x%04x\n",
2191 1.1 augustss index, OREAD4(sc, port)));
2192 1.1 augustss break;
2193 1.1 augustss case UHF_PORT_POWER:
2194 1.14 augustss DPRINTFN(2,("ohci_root_ctrl_transfer: set port power "
2195 1.14 augustss "%d\n", index));
2196 1.1 augustss OWRITE4(sc, port, UPS_PORT_POWER);
2197 1.1 augustss break;
2198 1.1 augustss default:
2199 1.53 augustss err = USBD_IOERROR;
2200 1.1 augustss goto ret;
2201 1.1 augustss }
2202 1.1 augustss break;
2203 1.1 augustss default:
2204 1.53 augustss err = USBD_IOERROR;
2205 1.1 augustss goto ret;
2206 1.1 augustss }
2207 1.53 augustss xfer->actlen = totlen;
2208 1.53 augustss err = USBD_NORMAL_COMPLETION;
2209 1.1 augustss ret:
2210 1.53 augustss xfer->status = err;
2211 1.46 augustss s = splusb();
2212 1.53 augustss usb_transfer_complete(xfer);
2213 1.46 augustss splx(s);
2214 1.1 augustss return (USBD_IN_PROGRESS);
2215 1.1 augustss }
2216 1.1 augustss
2217 1.1 augustss /* Abort a root control request. */
2218 1.55 augustss static void
2219 1.53 augustss ohci_root_ctrl_abort(xfer)
2220 1.53 augustss usbd_xfer_handle xfer;
2221 1.1 augustss {
2222 1.9 augustss /* Nothing to do, all transfers are synchronous. */
2223 1.1 augustss }
2224 1.1 augustss
2225 1.1 augustss /* Close the root pipe. */
2226 1.55 augustss static void
2227 1.1 augustss ohci_root_ctrl_close(pipe)
2228 1.1 augustss usbd_pipe_handle pipe;
2229 1.1 augustss {
2230 1.1 augustss DPRINTF(("ohci_root_ctrl_close\n"));
2231 1.34 augustss /* Nothing to do. */
2232 1.1 augustss }
2233 1.1 augustss
2234 1.55 augustss static usbd_status
2235 1.53 augustss ohci_root_intr_transfer(xfer)
2236 1.53 augustss usbd_xfer_handle xfer;
2237 1.1 augustss {
2238 1.53 augustss usbd_status err;
2239 1.17 augustss
2240 1.46 augustss /* Insert last in queue. */
2241 1.53 augustss err = usb_insert_transfer(xfer);
2242 1.53 augustss if (err)
2243 1.53 augustss return (err);
2244 1.46 augustss
2245 1.46 augustss /* Pipe isn't running, start first */
2246 1.53 augustss return (ohci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2247 1.17 augustss }
2248 1.17 augustss
2249 1.55 augustss static usbd_status
2250 1.53 augustss ohci_root_intr_start(xfer)
2251 1.53 augustss usbd_xfer_handle xfer;
2252 1.17 augustss {
2253 1.53 augustss usbd_pipe_handle pipe = xfer->pipe;
2254 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2255 1.1 augustss
2256 1.53 augustss sc->sc_intrxfer = xfer;
2257 1.1 augustss
2258 1.1 augustss return (USBD_IN_PROGRESS);
2259 1.1 augustss }
2260 1.1 augustss
2261 1.3 augustss /* Abort a root interrupt request. */
2262 1.55 augustss static void
2263 1.53 augustss ohci_root_intr_abort(xfer)
2264 1.53 augustss usbd_xfer_handle xfer;
2265 1.1 augustss {
2266 1.53 augustss int s;
2267 1.53 augustss
2268 1.53 augustss if (xfer->pipe->intrxfer == xfer) {
2269 1.51 augustss DPRINTF(("ohci_root_intr_abort: remove\n"));
2270 1.53 augustss xfer->pipe->intrxfer = NULL;
2271 1.51 augustss }
2272 1.53 augustss xfer->status = USBD_CANCELLED;
2273 1.53 augustss s = splusb();
2274 1.53 augustss usb_transfer_complete(xfer);
2275 1.53 augustss splx(s);
2276 1.1 augustss }
2277 1.1 augustss
2278 1.1 augustss /* Close the root pipe. */
2279 1.55 augustss static void
2280 1.1 augustss ohci_root_intr_close(pipe)
2281 1.1 augustss usbd_pipe_handle pipe;
2282 1.1 augustss {
2283 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2284 1.1 augustss
2285 1.1 augustss DPRINTF(("ohci_root_intr_close\n"));
2286 1.34 augustss
2287 1.53 augustss sc->sc_intrxfer = NULL;
2288 1.1 augustss }
2289 1.1 augustss
2290 1.1 augustss /************************/
2291 1.1 augustss
2292 1.55 augustss static usbd_status
2293 1.53 augustss ohci_device_ctrl_transfer(xfer)
2294 1.53 augustss usbd_xfer_handle xfer;
2295 1.1 augustss {
2296 1.53 augustss usbd_status err;
2297 1.17 augustss
2298 1.46 augustss /* Insert last in queue. */
2299 1.53 augustss err = usb_insert_transfer(xfer);
2300 1.53 augustss if (err)
2301 1.53 augustss return (err);
2302 1.46 augustss
2303 1.46 augustss /* Pipe isn't running, start first */
2304 1.53 augustss return (ohci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2305 1.17 augustss }
2306 1.17 augustss
2307 1.55 augustss static usbd_status
2308 1.53 augustss ohci_device_ctrl_start(xfer)
2309 1.53 augustss usbd_xfer_handle xfer;
2310 1.17 augustss {
2311 1.53 augustss ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
2312 1.53 augustss usbd_status err;
2313 1.1 augustss
2314 1.42 augustss #ifdef DIAGNOSTIC
2315 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST)) {
2316 1.1 augustss /* XXX panic */
2317 1.1 augustss printf("ohci_device_ctrl_transfer: not a request\n");
2318 1.1 augustss return (USBD_INVAL);
2319 1.1 augustss }
2320 1.42 augustss #endif
2321 1.1 augustss
2322 1.53 augustss err = ohci_device_request(xfer);
2323 1.53 augustss if (err)
2324 1.53 augustss return (err);
2325 1.1 augustss
2326 1.6 augustss if (sc->sc_bus.use_polling)
2327 1.53 augustss ohci_waitintr(sc, xfer);
2328 1.1 augustss return (USBD_IN_PROGRESS);
2329 1.1 augustss }
2330 1.1 augustss
2331 1.1 augustss /* Abort a device control request. */
2332 1.55 augustss static void
2333 1.53 augustss ohci_device_ctrl_abort(xfer)
2334 1.53 augustss usbd_xfer_handle xfer;
2335 1.1 augustss {
2336 1.53 augustss DPRINTF(("ohci_device_ctrl_abort: xfer=%p\n", xfer));
2337 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2338 1.1 augustss }
2339 1.1 augustss
2340 1.1 augustss /* Close a device control pipe. */
2341 1.55 augustss static void
2342 1.1 augustss ohci_device_ctrl_close(pipe)
2343 1.1 augustss usbd_pipe_handle pipe;
2344 1.1 augustss {
2345 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2346 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2347 1.1 augustss
2348 1.34 augustss DPRINTF(("ohci_device_ctrl_close: pipe=%p\n", pipe));
2349 1.34 augustss ohci_close_pipe(pipe, sc->sc_ctrl_head);
2350 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2351 1.3 augustss }
2352 1.3 augustss
2353 1.3 augustss /************************/
2354 1.37 augustss
2355 1.55 augustss static void
2356 1.37 augustss ohci_device_clear_toggle(pipe)
2357 1.37 augustss usbd_pipe_handle pipe;
2358 1.37 augustss {
2359 1.37 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2360 1.37 augustss
2361 1.39 augustss opipe->sed->ed.ed_tailp &= LE(~OHCI_TOGGLECARRY);
2362 1.37 augustss }
2363 1.37 augustss
2364 1.55 augustss static void
2365 1.37 augustss ohci_noop(pipe)
2366 1.37 augustss usbd_pipe_handle pipe;
2367 1.37 augustss {
2368 1.37 augustss }
2369 1.3 augustss
2370 1.55 augustss static usbd_status
2371 1.53 augustss ohci_device_bulk_transfer(xfer)
2372 1.53 augustss usbd_xfer_handle xfer;
2373 1.3 augustss {
2374 1.53 augustss usbd_status err;
2375 1.17 augustss
2376 1.46 augustss /* Insert last in queue. */
2377 1.53 augustss err = usb_insert_transfer(xfer);
2378 1.53 augustss if (err)
2379 1.53 augustss return (err);
2380 1.46 augustss
2381 1.46 augustss /* Pipe isn't running, start first */
2382 1.53 augustss return (ohci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2383 1.17 augustss }
2384 1.17 augustss
2385 1.55 augustss static usbd_status
2386 1.53 augustss ohci_device_bulk_start(xfer)
2387 1.53 augustss usbd_xfer_handle xfer;
2388 1.17 augustss {
2389 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2390 1.3 augustss usbd_device_handle dev = opipe->pipe.device;
2391 1.3 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2392 1.3 augustss int addr = dev->address;
2393 1.48 augustss ohci_soft_td_t *data, *tail, *tdp;
2394 1.3 augustss ohci_soft_ed_t *sed;
2395 1.40 augustss int s, len, isread, endpt;
2396 1.53 augustss usbd_status err;
2397 1.3 augustss
2398 1.34 augustss #ifdef DIAGNOSTIC
2399 1.53 augustss if (xfer->rqflags & URQ_REQUEST) {
2400 1.3 augustss /* XXX panic */
2401 1.34 augustss printf("ohci_device_bulk_start: a request\n");
2402 1.3 augustss return (USBD_INVAL);
2403 1.3 augustss }
2404 1.34 augustss #endif
2405 1.3 augustss
2406 1.53 augustss len = xfer->length;
2407 1.53 augustss endpt = xfer->pipe->endpoint->edesc->bEndpointAddress;
2408 1.40 augustss isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2409 1.3 augustss sed = opipe->sed;
2410 1.3 augustss
2411 1.53 augustss DPRINTFN(4,("ohci_device_bulk_start: xfer=%p len=%d isread=%d "
2412 1.53 augustss "flags=%d endpt=%d\n", xfer, len, isread, xfer->flags,
2413 1.40 augustss endpt));
2414 1.34 augustss
2415 1.32 augustss opipe->u.bulk.isread = isread;
2416 1.3 augustss opipe->u.bulk.length = len;
2417 1.3 augustss
2418 1.3 augustss /* Update device address */
2419 1.39 augustss sed->ed.ed_flags = LE(
2420 1.39 augustss (LE(sed->ed.ed_flags) & ~OHCI_ED_ADDRMASK) |
2421 1.16 augustss OHCI_ED_SET_FA(addr));
2422 1.3 augustss
2423 1.48 augustss /* Allocate a chain of new TDs (including a new tail). */
2424 1.60 augustss data = opipe->tail.td;
2425 1.61 augustss err = ohci_alloc_std_chain(opipe, sc, len, isread, xfer->flags,
2426 1.53 augustss &xfer->dmabuf, data, &tail);
2427 1.53 augustss if (err)
2428 1.53 augustss return (err);
2429 1.48 augustss
2430 1.53 augustss tail->xfer = NULL;
2431 1.53 augustss xfer->hcpriv = data;
2432 1.3 augustss
2433 1.34 augustss DPRINTFN(4,("ohci_device_bulk_start: ed_flags=0x%08x td_flags=0x%08x "
2434 1.34 augustss "td_cbp=0x%08x td_be=0x%08x\n",
2435 1.48 augustss (int)LE(sed->ed.ed_flags), (int)LE(data->td.td_flags),
2436 1.48 augustss (int)LE(data->td.td_cbp), (int)LE(data->td.td_be)));
2437 1.34 augustss
2438 1.52 augustss #ifdef OHCI_DEBUG
2439 1.34 augustss if (ohcidebug > 4) {
2440 1.34 augustss ohci_dump_ed(sed);
2441 1.48 augustss ohci_dump_tds(data);
2442 1.34 augustss }
2443 1.34 augustss #endif
2444 1.34 augustss
2445 1.3 augustss /* Insert ED in schedule */
2446 1.3 augustss s = splusb();
2447 1.48 augustss for (tdp = data; tdp != tail; tdp = tdp->nexttd) {
2448 1.53 augustss tdp->xfer = xfer;
2449 1.48 augustss ohci_hash_add_td(sc, tdp);
2450 1.48 augustss }
2451 1.39 augustss sed->ed.ed_tailp = LE(tail->physaddr);
2452 1.60 augustss opipe->tail.td = tail;
2453 1.39 augustss sed->ed.ed_flags &= LE(~OHCI_ED_SKIP);
2454 1.3 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF);
2455 1.53 augustss if (xfer->timeout && !sc->sc_bus.use_polling) {
2456 1.53 augustss usb_timeout(ohci_timeout, xfer,
2457 1.53 augustss MS_TO_TICKS(xfer->timeout), xfer->timo_handle);
2458 1.15 augustss }
2459 1.34 augustss
2460 1.52 augustss #if 0
2461 1.52 augustss /* This goes wrong if we are too slow. */
2462 1.34 augustss if (ohcidebug > 5) {
2463 1.55 augustss usb_delay_ms(&sc->sc_bus, 5);
2464 1.41 augustss DPRINTF(("ohci_device_intr_transfer: status=%x\n",
2465 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
2466 1.34 augustss ohci_dump_ed(sed);
2467 1.48 augustss ohci_dump_tds(data);
2468 1.34 augustss }
2469 1.34 augustss #endif
2470 1.34 augustss
2471 1.3 augustss splx(s);
2472 1.3 augustss
2473 1.3 augustss return (USBD_IN_PROGRESS);
2474 1.3 augustss }
2475 1.3 augustss
2476 1.55 augustss static void
2477 1.53 augustss ohci_device_bulk_abort(xfer)
2478 1.53 augustss usbd_xfer_handle xfer;
2479 1.3 augustss {
2480 1.53 augustss DPRINTF(("ohci_device_bulk_abort: xfer=%p\n", xfer));
2481 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2482 1.3 augustss }
2483 1.3 augustss
2484 1.34 augustss /*
2485 1.34 augustss * Close a device bulk pipe.
2486 1.34 augustss */
2487 1.55 augustss static void
2488 1.3 augustss ohci_device_bulk_close(pipe)
2489 1.3 augustss usbd_pipe_handle pipe;
2490 1.3 augustss {
2491 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2492 1.34 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2493 1.3 augustss
2494 1.34 augustss DPRINTF(("ohci_device_bulk_close: pipe=%p\n", pipe));
2495 1.34 augustss ohci_close_pipe(pipe, sc->sc_bulk_head);
2496 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2497 1.1 augustss }
2498 1.1 augustss
2499 1.1 augustss /************************/
2500 1.1 augustss
2501 1.55 augustss static usbd_status
2502 1.53 augustss ohci_device_intr_transfer(xfer)
2503 1.53 augustss usbd_xfer_handle xfer;
2504 1.17 augustss {
2505 1.53 augustss usbd_status err;
2506 1.17 augustss
2507 1.46 augustss /* Insert last in queue. */
2508 1.53 augustss err = usb_insert_transfer(xfer);
2509 1.53 augustss if (err)
2510 1.53 augustss return (err);
2511 1.46 augustss
2512 1.46 augustss /* Pipe isn't running, start first */
2513 1.53 augustss return (ohci_device_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2514 1.17 augustss }
2515 1.17 augustss
2516 1.55 augustss static usbd_status
2517 1.53 augustss ohci_device_intr_start(xfer)
2518 1.53 augustss usbd_xfer_handle xfer;
2519 1.1 augustss {
2520 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2521 1.1 augustss usbd_device_handle dev = opipe->pipe.device;
2522 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2523 1.1 augustss ohci_soft_ed_t *sed = opipe->sed;
2524 1.48 augustss ohci_soft_td_t *data, *tail;
2525 1.1 augustss int len;
2526 1.1 augustss int s;
2527 1.1 augustss
2528 1.53 augustss DPRINTFN(3, ("ohci_device_intr_transfer: xfer=%p len=%d "
2529 1.14 augustss "flags=%d priv=%p\n",
2530 1.53 augustss xfer, xfer->length, xfer->flags, xfer->priv));
2531 1.1 augustss
2532 1.42 augustss #ifdef DIAGNOSTIC
2533 1.53 augustss if (xfer->rqflags & URQ_REQUEST)
2534 1.1 augustss panic("ohci_device_intr_transfer: a request\n");
2535 1.42 augustss #endif
2536 1.1 augustss
2537 1.53 augustss len = xfer->length;
2538 1.1 augustss
2539 1.60 augustss data = opipe->tail.td;
2540 1.1 augustss tail = ohci_alloc_std(sc);
2541 1.55 augustss if (tail == NULL)
2542 1.43 augustss return (USBD_NOMEM);
2543 1.53 augustss tail->xfer = NULL;
2544 1.1 augustss
2545 1.48 augustss data->td.td_flags = LE(
2546 1.16 augustss OHCI_TD_IN | OHCI_TD_NOCC |
2547 1.16 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
2548 1.53 augustss if (xfer->flags & USBD_SHORT_XFER_OK)
2549 1.48 augustss data->td.td_flags |= LE(OHCI_TD_R);
2550 1.53 augustss data->td.td_cbp = LE(DMAADDR(&xfer->dmabuf));
2551 1.48 augustss data->nexttd = tail;
2552 1.48 augustss data->td.td_nexttd = LE(tail->physaddr);
2553 1.48 augustss data->td.td_be = LE(LE(data->td.td_cbp) + len - 1);
2554 1.48 augustss data->len = len;
2555 1.53 augustss data->xfer = xfer;
2556 1.48 augustss data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
2557 1.53 augustss xfer->hcpriv = data;
2558 1.1 augustss
2559 1.52 augustss #ifdef OHCI_DEBUG
2560 1.1 augustss if (ohcidebug > 5) {
2561 1.41 augustss DPRINTF(("ohci_device_intr_transfer:\n"));
2562 1.1 augustss ohci_dump_ed(sed);
2563 1.48 augustss ohci_dump_tds(data);
2564 1.1 augustss }
2565 1.1 augustss #endif
2566 1.1 augustss
2567 1.1 augustss /* Insert ED in schedule */
2568 1.1 augustss s = splusb();
2569 1.48 augustss ohci_hash_add_td(sc, data);
2570 1.39 augustss sed->ed.ed_tailp = LE(tail->physaddr);
2571 1.60 augustss opipe->tail.td = tail;
2572 1.39 augustss sed->ed.ed_flags &= LE(~OHCI_ED_SKIP);
2573 1.1 augustss
2574 1.52 augustss #if 0
2575 1.52 augustss /*
2576 1.52 augustss * This goes horribly wrong, printing thousands of descriptors,
2577 1.52 augustss * because false references are followed due to the fact that the
2578 1.52 augustss * TD is gone.
2579 1.52 augustss */
2580 1.1 augustss if (ohcidebug > 5) {
2581 1.55 augustss usb_delay_ms(&sc->sc_bus, 5);
2582 1.41 augustss DPRINTF(("ohci_device_intr_transfer: status=%x\n",
2583 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
2584 1.1 augustss ohci_dump_ed(sed);
2585 1.48 augustss ohci_dump_tds(data);
2586 1.1 augustss }
2587 1.1 augustss #endif
2588 1.26 augustss splx(s);
2589 1.1 augustss
2590 1.1 augustss return (USBD_IN_PROGRESS);
2591 1.1 augustss }
2592 1.1 augustss
2593 1.1 augustss /* Abort a device control request. */
2594 1.55 augustss static void
2595 1.53 augustss ohci_device_intr_abort(xfer)
2596 1.53 augustss usbd_xfer_handle xfer;
2597 1.1 augustss {
2598 1.53 augustss if (xfer->pipe->intrxfer == xfer) {
2599 1.1 augustss DPRINTF(("ohci_device_intr_abort: remove\n"));
2600 1.55 augustss xfer->pipe->intrxfer = NULL;
2601 1.1 augustss }
2602 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2603 1.1 augustss }
2604 1.1 augustss
2605 1.1 augustss /* Close a device interrupt pipe. */
2606 1.55 augustss static void
2607 1.1 augustss ohci_device_intr_close(pipe)
2608 1.1 augustss usbd_pipe_handle pipe;
2609 1.1 augustss {
2610 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2611 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2612 1.1 augustss int nslots = opipe->u.intr.nslots;
2613 1.1 augustss int pos = opipe->u.intr.pos;
2614 1.1 augustss int j;
2615 1.1 augustss ohci_soft_ed_t *p, *sed = opipe->sed;
2616 1.1 augustss int s;
2617 1.1 augustss
2618 1.1 augustss DPRINTFN(1,("ohci_device_intr_close: pipe=%p nslots=%d pos=%d\n",
2619 1.1 augustss pipe, nslots, pos));
2620 1.1 augustss s = splusb();
2621 1.39 augustss sed->ed.ed_flags |= LE(OHCI_ED_SKIP);
2622 1.39 augustss if ((sed->ed.ed_tailp & LE(OHCI_TAILMASK)) !=
2623 1.39 augustss (sed->ed.ed_headp & LE(OHCI_TAILMASK)))
2624 1.20 augustss usb_delay_ms(&sc->sc_bus, 2);
2625 1.1 augustss
2626 1.1 augustss for (p = sc->sc_eds[pos]; p && p->next != sed; p = p->next)
2627 1.1 augustss ;
2628 1.53 augustss #ifdef DIAGNOSTIC
2629 1.53 augustss if (p == NULL)
2630 1.1 augustss panic("ohci_device_intr_close: ED not found\n");
2631 1.53 augustss #endif
2632 1.1 augustss p->next = sed->next;
2633 1.39 augustss p->ed.ed_nexted = sed->ed.ed_nexted;
2634 1.1 augustss splx(s);
2635 1.1 augustss
2636 1.1 augustss for (j = 0; j < nslots; j++)
2637 1.31 wrstuden --sc->sc_bws[(pos * nslots + j) % OHCI_NO_INTRS];
2638 1.1 augustss
2639 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2640 1.1 augustss ohci_free_sed(sc, opipe->sed);
2641 1.1 augustss }
2642 1.1 augustss
2643 1.55 augustss static usbd_status
2644 1.1 augustss ohci_device_setintr(sc, opipe, ival)
2645 1.1 augustss ohci_softc_t *sc;
2646 1.1 augustss struct ohci_pipe *opipe;
2647 1.1 augustss int ival;
2648 1.1 augustss {
2649 1.1 augustss int i, j, s, best;
2650 1.1 augustss u_int npoll, slow, shigh, nslots;
2651 1.1 augustss u_int bestbw, bw;
2652 1.1 augustss ohci_soft_ed_t *hsed, *sed = opipe->sed;
2653 1.1 augustss
2654 1.1 augustss DPRINTFN(2, ("ohci_setintr: pipe=%p\n", opipe));
2655 1.1 augustss if (ival == 0) {
2656 1.1 augustss printf("ohci_setintr: 0 interval\n");
2657 1.1 augustss return (USBD_INVAL);
2658 1.1 augustss }
2659 1.1 augustss
2660 1.1 augustss npoll = OHCI_NO_INTRS;
2661 1.1 augustss while (npoll > ival)
2662 1.1 augustss npoll /= 2;
2663 1.1 augustss DPRINTFN(2, ("ohci_setintr: ival=%d npoll=%d\n", ival, npoll));
2664 1.1 augustss
2665 1.1 augustss /*
2666 1.1 augustss * We now know which level in the tree the ED must go into.
2667 1.1 augustss * Figure out which slot has most bandwidth left over.
2668 1.1 augustss * Slots to examine:
2669 1.1 augustss * npoll
2670 1.1 augustss * 1 0
2671 1.1 augustss * 2 1 2
2672 1.1 augustss * 4 3 4 5 6
2673 1.1 augustss * 8 7 8 9 10 11 12 13 14
2674 1.1 augustss * N (N-1) .. (N-1+N-1)
2675 1.1 augustss */
2676 1.1 augustss slow = npoll-1;
2677 1.1 augustss shigh = slow + npoll;
2678 1.1 augustss nslots = OHCI_NO_INTRS / npoll;
2679 1.1 augustss for (best = i = slow, bestbw = ~0; i < shigh; i++) {
2680 1.1 augustss bw = 0;
2681 1.1 augustss for (j = 0; j < nslots; j++)
2682 1.28 augustss bw += sc->sc_bws[(i * nslots + j) % OHCI_NO_INTRS];
2683 1.1 augustss if (bw < bestbw) {
2684 1.1 augustss best = i;
2685 1.1 augustss bestbw = bw;
2686 1.1 augustss }
2687 1.1 augustss }
2688 1.1 augustss DPRINTFN(2, ("ohci_setintr: best=%d(%d..%d) bestbw=%d\n",
2689 1.1 augustss best, slow, shigh, bestbw));
2690 1.1 augustss
2691 1.1 augustss s = splusb();
2692 1.1 augustss hsed = sc->sc_eds[best];
2693 1.1 augustss sed->next = hsed->next;
2694 1.39 augustss sed->ed.ed_nexted = hsed->ed.ed_nexted;
2695 1.1 augustss hsed->next = sed;
2696 1.39 augustss hsed->ed.ed_nexted = LE(sed->physaddr);
2697 1.1 augustss splx(s);
2698 1.1 augustss
2699 1.1 augustss for (j = 0; j < nslots; j++)
2700 1.28 augustss ++sc->sc_bws[(best * nslots + j) % OHCI_NO_INTRS];
2701 1.1 augustss opipe->u.intr.nslots = nslots;
2702 1.1 augustss opipe->u.intr.pos = best;
2703 1.1 augustss
2704 1.1 augustss DPRINTFN(5, ("ohci_setintr: returns %p\n", opipe));
2705 1.1 augustss return (USBD_NORMAL_COMPLETION);
2706 1.60 augustss }
2707 1.60 augustss
2708 1.60 augustss /***********************/
2709 1.60 augustss
2710 1.60 augustss usbd_status
2711 1.60 augustss ohci_device_isoc_transfer(xfer)
2712 1.60 augustss usbd_xfer_handle xfer;
2713 1.60 augustss {
2714 1.60 augustss usbd_status err;
2715 1.60 augustss
2716 1.60 augustss DPRINTFN(5,("ohci_device_isoc_transfer: xfer=%p\n", xfer));
2717 1.60 augustss
2718 1.60 augustss /* Put it on our queue, */
2719 1.60 augustss err = usb_insert_transfer(xfer);
2720 1.60 augustss
2721 1.60 augustss /* bail out on error, */
2722 1.60 augustss if (err && err != USBD_IN_PROGRESS)
2723 1.60 augustss return (err);
2724 1.60 augustss
2725 1.60 augustss /* XXX should check inuse here */
2726 1.60 augustss
2727 1.60 augustss /* insert into schedule, */
2728 1.60 augustss ohci_device_isoc_enter(xfer);
2729 1.60 augustss
2730 1.60 augustss /* and put on interrupt list if the pipe wasn't running */
2731 1.60 augustss if (!err)
2732 1.60 augustss ohci_device_isoc_start(SIMPLEQ_FIRST(&xfer->pipe->queue));
2733 1.60 augustss
2734 1.60 augustss return (err);
2735 1.60 augustss }
2736 1.60 augustss
2737 1.60 augustss void
2738 1.60 augustss ohci_device_isoc_enter(xfer)
2739 1.60 augustss usbd_xfer_handle xfer;
2740 1.60 augustss {
2741 1.61 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2742 1.61 augustss usbd_device_handle dev = opipe->pipe.device;
2743 1.61 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2744 1.61 augustss ohci_soft_ed_t *sed = opipe->sed;
2745 1.61 augustss struct iso *iso = &opipe->u.iso;
2746 1.61 augustss ohci_soft_itd_t *sitd, *nsitd;
2747 1.61 augustss ohci_physaddr_t buf, offs;
2748 1.61 augustss int i, ncur, nframes;
2749 1.61 augustss int ncross;
2750 1.61 augustss int s;
2751 1.61 augustss
2752 1.61 augustss s = splusb();
2753 1.61 augustss sitd = opipe->tail.itd;
2754 1.61 augustss buf = DMAADDR(&xfer->dmabuf);
2755 1.61 augustss sitd->itd.itd_bp0 = LE(buf & OHCI_ITD_PAGE_MASK);
2756 1.61 augustss nframes = xfer->nframes;
2757 1.61 augustss offs = buf & OHCI_ITD_OFFSET_MASK;
2758 1.61 augustss for (i = ncur = 0; i < nframes; i++, ncur++) {
2759 1.61 augustss if (ncur == OHCI_ITD_NOFFSET || /* all offsets used */
2760 1.61 augustss ncross > 1) { /* too many page crossings */
2761 1.61 augustss
2762 1.61 augustss nsitd = ohci_alloc_sitd(sc);
2763 1.61 augustss if (nsitd == NULL) {
2764 1.61 augustss /* XXX what now? */
2765 1.61 augustss return;
2766 1.61 augustss }
2767 1.61 augustss sitd->nextitd = nsitd;
2768 1.61 augustss sitd->itd.itd_nextitd = LE(nsitd->physaddr);
2769 1.61 augustss sitd->itd.itd_flags = LE(
2770 1.61 augustss OHCI_ITD_NOCC |
2771 1.61 augustss OHCI_ITD_SET_SF(iso->next) |
2772 1.61 augustss OHCI_ITD_NOINTR |
2773 1.61 augustss OHCI_ITD_SET_FC(OHCI_ITD_NOFFSET));
2774 1.61 augustss sitd->itd.itd_be = LE(LE(sitd->itd.itd_bp0) + offs - 1);
2775 1.61 augustss nsitd->itd.itd_bp0 = LE((buf + offs) & OHCI_ITD_PAGE_MASK);
2776 1.61 augustss sitd = nsitd;
2777 1.61 augustss iso->next = iso->next + ncur;
2778 1.61 augustss ncur = 0;
2779 1.61 augustss ncross = 0;
2780 1.61 augustss }
2781 1.61 augustss /* XXX byte order */
2782 1.61 augustss sitd->itd.itd_offset[i] =
2783 1.61 augustss offs | (ncross == 1 ? OHCI_ITD_PAGE_SELECT : 0);
2784 1.61 augustss offs += xfer->frlengths[i];
2785 1.61 augustss /* XXX update ncross */
2786 1.61 augustss }
2787 1.61 augustss nsitd = ohci_alloc_sitd(sc);
2788 1.61 augustss if (nsitd == NULL) {
2789 1.61 augustss /* XXX what now? */
2790 1.61 augustss return;
2791 1.61 augustss }
2792 1.61 augustss sitd->nextitd = nsitd;
2793 1.61 augustss sitd->itd.itd_nextitd = LE(nsitd->physaddr);
2794 1.61 augustss sitd->itd.itd_flags = LE(
2795 1.61 augustss OHCI_ITD_NOCC |
2796 1.61 augustss OHCI_ITD_SET_SF(iso->next) |
2797 1.61 augustss OHCI_ITD_SET_DI(0) |
2798 1.61 augustss OHCI_ITD_SET_FC(ncur));
2799 1.61 augustss sitd->itd.itd_be = LE(LE(sitd->itd.itd_bp0) + offs - 1);
2800 1.61 augustss iso->next = iso->next + ncur;
2801 1.61 augustss
2802 1.61 augustss opipe->tail.itd = nsitd;
2803 1.61 augustss sed->ed.ed_tailp = LE(nsitd->physaddr);
2804 1.61 augustss /* XXX update ED */
2805 1.61 augustss splx(s);
2806 1.60 augustss }
2807 1.60 augustss
2808 1.60 augustss usbd_status
2809 1.60 augustss ohci_device_isoc_start(xfer)
2810 1.60 augustss usbd_xfer_handle xfer;
2811 1.60 augustss {
2812 1.60 augustss printf("ohci_device_isoc_start: not implemented\n");
2813 1.60 augustss return (USBD_INVAL);
2814 1.60 augustss }
2815 1.60 augustss
2816 1.60 augustss void
2817 1.60 augustss ohci_device_isoc_abort(xfer)
2818 1.60 augustss usbd_xfer_handle xfer;
2819 1.60 augustss {
2820 1.60 augustss }
2821 1.60 augustss
2822 1.60 augustss void
2823 1.60 augustss ohci_device_isoc_done(xfer)
2824 1.60 augustss usbd_xfer_handle xfer;
2825 1.60 augustss {
2826 1.60 augustss printf("ohci_device_isoc_done: not implemented\n");
2827 1.60 augustss }
2828 1.60 augustss
2829 1.60 augustss usbd_status
2830 1.60 augustss ohci_setup_isoc(pipe)
2831 1.60 augustss usbd_pipe_handle pipe;
2832 1.60 augustss {
2833 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2834 1.60 augustss struct iso *iso = &opipe->u.iso;
2835 1.60 augustss
2836 1.60 augustss iso->next = -1;
2837 1.60 augustss iso->inuse = 0;
2838 1.60 augustss
2839 1.60 augustss return (USBD_NORMAL_COMPLETION);
2840 1.60 augustss }
2841 1.60 augustss
2842 1.60 augustss void
2843 1.60 augustss ohci_device_isoc_close(pipe)
2844 1.60 augustss usbd_pipe_handle pipe;
2845 1.60 augustss {
2846 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2847 1.60 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2848 1.60 augustss
2849 1.60 augustss DPRINTF(("ohci_device_isoc_close: pipe=%p\n", pipe));
2850 1.60 augustss ohci_close_pipe(pipe, sc->sc_isoc_head);
2851 1.60 augustss ohci_free_sitd(sc, opipe->tail.itd);
2852 1.1 augustss }
2853