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