ohci.c revision 1.170 1 1.170 christos /* $NetBSD: ohci.c,v 1.170 2006/03/30 19:08:31 christos 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.157 mycroft * Copyright (c) 1998, 2004, 2005 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.89 augustss * by Lennart Augustsson (lennart (at) augustsson.net) at
10 1.11 augustss * Carlstedt Research & Technology.
11 1.157 mycroft * This code is derived from software contributed to The NetBSD Foundation
12 1.157 mycroft * by Charles M. Hannum.
13 1.1 augustss *
14 1.1 augustss * Redistribution and use in source and binary forms, with or without
15 1.1 augustss * modification, are permitted provided that the following conditions
16 1.1 augustss * are met:
17 1.1 augustss * 1. Redistributions of source code must retain the above copyright
18 1.1 augustss * notice, this list of conditions and the following disclaimer.
19 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
20 1.1 augustss * notice, this list of conditions and the following disclaimer in the
21 1.1 augustss * documentation and/or other materials provided with the distribution.
22 1.1 augustss * 3. All advertising materials mentioning features or use of this software
23 1.1 augustss * must display the following acknowledgement:
24 1.1 augustss * This product includes software developed by the NetBSD
25 1.1 augustss * Foundation, Inc. and its contributors.
26 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
27 1.1 augustss * contributors may be used to endorse or promote products derived
28 1.1 augustss * from this software without specific prior written permission.
29 1.1 augustss *
30 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
31 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
32 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
33 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
34 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
35 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
36 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
37 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
38 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
39 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
40 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
41 1.1 augustss */
42 1.1 augustss
43 1.1 augustss /*
44 1.1 augustss * USB Open Host Controller driver.
45 1.1 augustss *
46 1.96 augustss * OHCI spec: http://www.compaq.com/productinfo/development/openhci.html
47 1.138 ichiro * USB spec: http://www.usb.org/developers/docs/usbspec.zip
48 1.1 augustss */
49 1.108 lukem
50 1.108 lukem #include <sys/cdefs.h>
51 1.170 christos __KERNEL_RCSID(0, "$NetBSD: ohci.c,v 1.170 2006/03/30 19:08:31 christos Exp $");
52 1.1 augustss
53 1.1 augustss #include <sys/param.h>
54 1.1 augustss #include <sys/systm.h>
55 1.1 augustss #include <sys/malloc.h>
56 1.36 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
57 1.55 augustss #include <sys/kernel.h>
58 1.1 augustss #include <sys/device.h>
59 1.55 augustss #include <sys/select.h>
60 1.153 fvdl #include <uvm/uvm_extern.h>
61 1.15 augustss #elif defined(__FreeBSD__)
62 1.15 augustss #include <sys/module.h>
63 1.15 augustss #include <sys/bus.h>
64 1.52 augustss #include <machine/bus_pio.h>
65 1.52 augustss #include <machine/bus_memio.h>
66 1.55 augustss #if defined(DIAGNOSTIC) && defined(__i386__) && defined(__FreeBSD__)
67 1.55 augustss #include <machine/cpu.h>
68 1.55 augustss #endif
69 1.15 augustss #endif
70 1.1 augustss #include <sys/proc.h>
71 1.1 augustss #include <sys/queue.h>
72 1.1 augustss
73 1.4 augustss #include <machine/bus.h>
74 1.16 augustss #include <machine/endian.h>
75 1.4 augustss
76 1.1 augustss #include <dev/usb/usb.h>
77 1.1 augustss #include <dev/usb/usbdi.h>
78 1.1 augustss #include <dev/usb/usbdivar.h>
79 1.38 augustss #include <dev/usb/usb_mem.h>
80 1.1 augustss #include <dev/usb/usb_quirks.h>
81 1.1 augustss
82 1.1 augustss #include <dev/usb/ohcireg.h>
83 1.1 augustss #include <dev/usb/ohcivar.h>
84 1.1 augustss
85 1.15 augustss #if defined(__FreeBSD__)
86 1.15 augustss #include <machine/clock.h>
87 1.55 augustss
88 1.15 augustss #define delay(d) DELAY(d)
89 1.15 augustss #endif
90 1.1 augustss
91 1.36 augustss #if defined(__OpenBSD__)
92 1.36 augustss struct cfdriver ohci_cd = {
93 1.36 augustss NULL, "ohci", DV_DULL
94 1.36 augustss };
95 1.36 augustss #endif
96 1.36 augustss
97 1.52 augustss #ifdef OHCI_DEBUG
98 1.52 augustss #define DPRINTF(x) if (ohcidebug) logprintf x
99 1.52 augustss #define DPRINTFN(n,x) if (ohcidebug>(n)) logprintf x
100 1.52 augustss int ohcidebug = 0;
101 1.92 tv #ifndef __NetBSD__
102 1.92 tv #define bitmask_snprintf(q,f,b,l) snprintf((b), (l), "%b", (q), (f))
103 1.92 tv #endif
104 1.52 augustss #else
105 1.52 augustss #define DPRINTF(x)
106 1.52 augustss #define DPRINTFN(n,x)
107 1.52 augustss #endif
108 1.52 augustss
109 1.16 augustss #if BYTE_ORDER == BIG_ENDIAN
110 1.169 tron #define SWAP_ENDIAN OHCI_LITTLE_ENDIAN
111 1.16 augustss #else
112 1.169 tron #define SWAP_ENDIAN OHCI_BIG_ENDIAN
113 1.16 augustss #endif
114 1.16 augustss
115 1.169 tron #define O16TOH(val) (sc->sc_endian == SWAP_ENDIAN ? bswap16(val) : val)
116 1.169 tron #define O32TOH(val) (sc->sc_endian == SWAP_ENDIAN ? bswap32(val) : val)
117 1.169 tron #define HTOO16(val) O16TOH(val)
118 1.169 tron #define HTOO32(val) O32TOH(val)
119 1.168 augustss
120 1.1 augustss struct ohci_pipe;
121 1.1 augustss
122 1.91 augustss Static ohci_soft_ed_t *ohci_alloc_sed(ohci_softc_t *);
123 1.91 augustss Static void ohci_free_sed(ohci_softc_t *, ohci_soft_ed_t *);
124 1.1 augustss
125 1.91 augustss Static ohci_soft_td_t *ohci_alloc_std(ohci_softc_t *);
126 1.91 augustss Static void ohci_free_std(ohci_softc_t *, ohci_soft_td_t *);
127 1.1 augustss
128 1.91 augustss Static ohci_soft_itd_t *ohci_alloc_sitd(ohci_softc_t *);
129 1.91 augustss Static void ohci_free_sitd(ohci_softc_t *,ohci_soft_itd_t *);
130 1.60 augustss
131 1.53 augustss #if 0
132 1.91 augustss Static void ohci_free_std_chain(ohci_softc_t *, ohci_soft_td_t *,
133 1.91 augustss ohci_soft_td_t *);
134 1.53 augustss #endif
135 1.91 augustss Static usbd_status ohci_alloc_std_chain(struct ohci_pipe *,
136 1.77 augustss ohci_softc_t *, int, int, usbd_xfer_handle,
137 1.91 augustss ohci_soft_td_t *, ohci_soft_td_t **);
138 1.53 augustss
139 1.91 augustss Static void ohci_shutdown(void *v);
140 1.91 augustss Static void ohci_power(int, void *);
141 1.91 augustss Static usbd_status ohci_open(usbd_pipe_handle);
142 1.91 augustss Static void ohci_poll(struct usbd_bus *);
143 1.99 augustss Static void ohci_softintr(void *);
144 1.91 augustss Static void ohci_waitintr(ohci_softc_t *, usbd_xfer_handle);
145 1.91 augustss Static void ohci_rhsc(ohci_softc_t *, usbd_xfer_handle);
146 1.91 augustss
147 1.91 augustss Static usbd_status ohci_device_request(usbd_xfer_handle xfer);
148 1.168 augustss Static void ohci_add_ed(ohci_softc_t *, ohci_soft_ed_t *,
149 1.168 augustss ohci_soft_ed_t *);
150 1.168 augustss
151 1.91 augustss Static void ohci_rem_ed(ohci_soft_ed_t *, ohci_soft_ed_t *);
152 1.91 augustss Static void ohci_hash_add_td(ohci_softc_t *, ohci_soft_td_t *);
153 1.91 augustss Static void ohci_hash_rem_td(ohci_softc_t *, ohci_soft_td_t *);
154 1.91 augustss Static ohci_soft_td_t *ohci_hash_find_td(ohci_softc_t *, ohci_physaddr_t);
155 1.91 augustss Static void ohci_hash_add_itd(ohci_softc_t *, ohci_soft_itd_t *);
156 1.91 augustss Static void ohci_hash_rem_itd(ohci_softc_t *, ohci_soft_itd_t *);
157 1.91 augustss Static ohci_soft_itd_t *ohci_hash_find_itd(ohci_softc_t *, ohci_physaddr_t);
158 1.91 augustss
159 1.91 augustss Static usbd_status ohci_setup_isoc(usbd_pipe_handle pipe);
160 1.91 augustss Static void ohci_device_isoc_enter(usbd_xfer_handle);
161 1.91 augustss
162 1.91 augustss Static usbd_status ohci_allocm(struct usbd_bus *, usb_dma_t *, u_int32_t);
163 1.91 augustss Static void ohci_freem(struct usbd_bus *, usb_dma_t *);
164 1.91 augustss
165 1.91 augustss Static usbd_xfer_handle ohci_allocx(struct usbd_bus *);
166 1.91 augustss Static void ohci_freex(struct usbd_bus *, usbd_xfer_handle);
167 1.91 augustss
168 1.91 augustss Static usbd_status ohci_root_ctrl_transfer(usbd_xfer_handle);
169 1.91 augustss Static usbd_status ohci_root_ctrl_start(usbd_xfer_handle);
170 1.91 augustss Static void ohci_root_ctrl_abort(usbd_xfer_handle);
171 1.91 augustss Static void ohci_root_ctrl_close(usbd_pipe_handle);
172 1.91 augustss Static void ohci_root_ctrl_done(usbd_xfer_handle);
173 1.91 augustss
174 1.91 augustss Static usbd_status ohci_root_intr_transfer(usbd_xfer_handle);
175 1.91 augustss Static usbd_status ohci_root_intr_start(usbd_xfer_handle);
176 1.91 augustss Static void ohci_root_intr_abort(usbd_xfer_handle);
177 1.91 augustss Static void ohci_root_intr_close(usbd_pipe_handle);
178 1.91 augustss Static void ohci_root_intr_done(usbd_xfer_handle);
179 1.91 augustss
180 1.91 augustss Static usbd_status ohci_device_ctrl_transfer(usbd_xfer_handle);
181 1.91 augustss Static usbd_status ohci_device_ctrl_start(usbd_xfer_handle);
182 1.91 augustss Static void ohci_device_ctrl_abort(usbd_xfer_handle);
183 1.91 augustss Static void ohci_device_ctrl_close(usbd_pipe_handle);
184 1.91 augustss Static void ohci_device_ctrl_done(usbd_xfer_handle);
185 1.91 augustss
186 1.91 augustss Static usbd_status ohci_device_bulk_transfer(usbd_xfer_handle);
187 1.91 augustss Static usbd_status ohci_device_bulk_start(usbd_xfer_handle);
188 1.91 augustss Static void ohci_device_bulk_abort(usbd_xfer_handle);
189 1.91 augustss Static void ohci_device_bulk_close(usbd_pipe_handle);
190 1.91 augustss Static void ohci_device_bulk_done(usbd_xfer_handle);
191 1.91 augustss
192 1.91 augustss Static usbd_status ohci_device_intr_transfer(usbd_xfer_handle);
193 1.91 augustss Static usbd_status ohci_device_intr_start(usbd_xfer_handle);
194 1.91 augustss Static void ohci_device_intr_abort(usbd_xfer_handle);
195 1.91 augustss Static void ohci_device_intr_close(usbd_pipe_handle);
196 1.91 augustss Static void ohci_device_intr_done(usbd_xfer_handle);
197 1.91 augustss
198 1.91 augustss Static usbd_status ohci_device_isoc_transfer(usbd_xfer_handle);
199 1.91 augustss Static usbd_status ohci_device_isoc_start(usbd_xfer_handle);
200 1.91 augustss Static void ohci_device_isoc_abort(usbd_xfer_handle);
201 1.91 augustss Static void ohci_device_isoc_close(usbd_pipe_handle);
202 1.91 augustss Static void ohci_device_isoc_done(usbd_xfer_handle);
203 1.91 augustss
204 1.120 augustss Static usbd_status ohci_device_setintr(ohci_softc_t *sc,
205 1.91 augustss struct ohci_pipe *pipe, int ival);
206 1.91 augustss
207 1.120 augustss Static int ohci_str(usb_string_descriptor_t *, int, const char *);
208 1.91 augustss
209 1.91 augustss Static void ohci_timeout(void *);
210 1.114 augustss Static void ohci_timeout_task(void *);
211 1.104 augustss Static void ohci_rhsc_enable(void *);
212 1.91 augustss
213 1.91 augustss Static void ohci_close_pipe(usbd_pipe_handle, ohci_soft_ed_t *);
214 1.91 augustss Static void ohci_abort_xfer(usbd_xfer_handle, usbd_status);
215 1.53 augustss
216 1.91 augustss Static void ohci_device_clear_toggle(usbd_pipe_handle pipe);
217 1.91 augustss Static void ohci_noop(usbd_pipe_handle pipe);
218 1.37 augustss
219 1.52 augustss #ifdef OHCI_DEBUG
220 1.91 augustss Static void ohci_dumpregs(ohci_softc_t *);
221 1.168 augustss Static void ohci_dump_tds(ohci_softc_t *, ohci_soft_td_t *);
222 1.168 augustss Static void ohci_dump_td(ohci_softc_t *, ohci_soft_td_t *);
223 1.168 augustss Static void ohci_dump_ed(ohci_softc_t *, ohci_soft_ed_t *);
224 1.168 augustss Static void ohci_dump_itd(ohci_softc_t *, ohci_soft_itd_t *);
225 1.168 augustss Static void ohci_dump_itds(ohci_softc_t *, ohci_soft_itd_t *);
226 1.1 augustss #endif
227 1.1 augustss
228 1.88 augustss #define OBARR(sc) bus_space_barrier((sc)->iot, (sc)->ioh, 0, (sc)->sc_size, \
229 1.88 augustss BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE)
230 1.88 augustss #define OWRITE1(sc, r, x) \
231 1.88 augustss do { OBARR(sc); bus_space_write_1((sc)->iot, (sc)->ioh, (r), (x)); } while (0)
232 1.88 augustss #define OWRITE2(sc, r, x) \
233 1.88 augustss do { OBARR(sc); bus_space_write_2((sc)->iot, (sc)->ioh, (r), (x)); } while (0)
234 1.88 augustss #define OWRITE4(sc, r, x) \
235 1.88 augustss do { OBARR(sc); bus_space_write_4((sc)->iot, (sc)->ioh, (r), (x)); } while (0)
236 1.88 augustss #define OREAD1(sc, r) (OBARR(sc), bus_space_read_1((sc)->iot, (sc)->ioh, (r)))
237 1.88 augustss #define OREAD2(sc, r) (OBARR(sc), bus_space_read_2((sc)->iot, (sc)->ioh, (r)))
238 1.88 augustss #define OREAD4(sc, r) (OBARR(sc), bus_space_read_4((sc)->iot, (sc)->ioh, (r)))
239 1.1 augustss
240 1.1 augustss /* Reverse the bits in a value 0 .. 31 */
241 1.120 augustss Static u_int8_t revbits[OHCI_NO_INTRS] =
242 1.1 augustss { 0x00, 0x10, 0x08, 0x18, 0x04, 0x14, 0x0c, 0x1c,
243 1.1 augustss 0x02, 0x12, 0x0a, 0x1a, 0x06, 0x16, 0x0e, 0x1e,
244 1.1 augustss 0x01, 0x11, 0x09, 0x19, 0x05, 0x15, 0x0d, 0x1d,
245 1.1 augustss 0x03, 0x13, 0x0b, 0x1b, 0x07, 0x17, 0x0f, 0x1f };
246 1.1 augustss
247 1.1 augustss struct ohci_pipe {
248 1.1 augustss struct usbd_pipe pipe;
249 1.1 augustss ohci_soft_ed_t *sed;
250 1.60 augustss union {
251 1.60 augustss ohci_soft_td_t *td;
252 1.60 augustss ohci_soft_itd_t *itd;
253 1.60 augustss } tail;
254 1.1 augustss /* Info needed for different pipe kinds. */
255 1.1 augustss union {
256 1.1 augustss /* Control pipe */
257 1.1 augustss struct {
258 1.4 augustss usb_dma_t reqdma;
259 1.1 augustss u_int length;
260 1.48 augustss ohci_soft_td_t *setup, *data, *stat;
261 1.1 augustss } ctl;
262 1.1 augustss /* Interrupt pipe */
263 1.1 augustss struct {
264 1.1 augustss int nslots;
265 1.1 augustss int pos;
266 1.1 augustss } intr;
267 1.3 augustss /* Bulk pipe */
268 1.3 augustss struct {
269 1.3 augustss u_int length;
270 1.32 augustss int isread;
271 1.3 augustss } bulk;
272 1.43 augustss /* Iso pipe */
273 1.43 augustss struct iso {
274 1.60 augustss int next, inuse;
275 1.43 augustss } iso;
276 1.1 augustss } u;
277 1.1 augustss };
278 1.1 augustss
279 1.1 augustss #define OHCI_INTR_ENDPT 1
280 1.1 augustss
281 1.82 augustss Static struct usbd_bus_methods ohci_bus_methods = {
282 1.42 augustss ohci_open,
283 1.73 augustss ohci_softintr,
284 1.42 augustss ohci_poll,
285 1.42 augustss ohci_allocm,
286 1.42 augustss ohci_freem,
287 1.62 augustss ohci_allocx,
288 1.62 augustss ohci_freex,
289 1.42 augustss };
290 1.42 augustss
291 1.120 augustss Static struct usbd_pipe_methods ohci_root_ctrl_methods = {
292 1.1 augustss ohci_root_ctrl_transfer,
293 1.17 augustss ohci_root_ctrl_start,
294 1.1 augustss ohci_root_ctrl_abort,
295 1.1 augustss ohci_root_ctrl_close,
296 1.37 augustss ohci_noop,
297 1.65 augustss ohci_root_ctrl_done,
298 1.1 augustss };
299 1.1 augustss
300 1.120 augustss Static struct usbd_pipe_methods ohci_root_intr_methods = {
301 1.1 augustss ohci_root_intr_transfer,
302 1.17 augustss ohci_root_intr_start,
303 1.1 augustss ohci_root_intr_abort,
304 1.1 augustss ohci_root_intr_close,
305 1.37 augustss ohci_noop,
306 1.38 augustss ohci_root_intr_done,
307 1.1 augustss };
308 1.1 augustss
309 1.120 augustss Static struct usbd_pipe_methods ohci_device_ctrl_methods = {
310 1.1 augustss ohci_device_ctrl_transfer,
311 1.17 augustss ohci_device_ctrl_start,
312 1.1 augustss ohci_device_ctrl_abort,
313 1.1 augustss ohci_device_ctrl_close,
314 1.37 augustss ohci_noop,
315 1.38 augustss ohci_device_ctrl_done,
316 1.1 augustss };
317 1.1 augustss
318 1.120 augustss Static struct usbd_pipe_methods ohci_device_intr_methods = {
319 1.1 augustss ohci_device_intr_transfer,
320 1.17 augustss ohci_device_intr_start,
321 1.1 augustss ohci_device_intr_abort,
322 1.1 augustss ohci_device_intr_close,
323 1.37 augustss ohci_device_clear_toggle,
324 1.38 augustss ohci_device_intr_done,
325 1.1 augustss };
326 1.1 augustss
327 1.120 augustss Static struct usbd_pipe_methods ohci_device_bulk_methods = {
328 1.3 augustss ohci_device_bulk_transfer,
329 1.17 augustss ohci_device_bulk_start,
330 1.3 augustss ohci_device_bulk_abort,
331 1.3 augustss ohci_device_bulk_close,
332 1.37 augustss ohci_device_clear_toggle,
333 1.38 augustss ohci_device_bulk_done,
334 1.3 augustss };
335 1.3 augustss
336 1.82 augustss Static struct usbd_pipe_methods ohci_device_isoc_methods = {
337 1.43 augustss ohci_device_isoc_transfer,
338 1.43 augustss ohci_device_isoc_start,
339 1.43 augustss ohci_device_isoc_abort,
340 1.43 augustss ohci_device_isoc_close,
341 1.43 augustss ohci_noop,
342 1.43 augustss ohci_device_isoc_done,
343 1.43 augustss };
344 1.43 augustss
345 1.55 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
346 1.47 augustss int
347 1.91 augustss ohci_activate(device_ptr_t self, enum devact act)
348 1.47 augustss {
349 1.49 augustss struct ohci_softc *sc = (struct ohci_softc *)self;
350 1.47 augustss int rv = 0;
351 1.47 augustss
352 1.47 augustss switch (act) {
353 1.47 augustss case DVACT_ACTIVATE:
354 1.47 augustss return (EOPNOTSUPP);
355 1.47 augustss
356 1.47 augustss case DVACT_DEACTIVATE:
357 1.49 augustss if (sc->sc_child != NULL)
358 1.49 augustss rv = config_deactivate(sc->sc_child);
359 1.83 augustss sc->sc_dying = 1;
360 1.47 augustss break;
361 1.47 augustss }
362 1.47 augustss return (rv);
363 1.47 augustss }
364 1.47 augustss
365 1.47 augustss int
366 1.91 augustss ohci_detach(struct ohci_softc *sc, int flags)
367 1.47 augustss {
368 1.47 augustss int rv = 0;
369 1.47 augustss
370 1.47 augustss if (sc->sc_child != NULL)
371 1.47 augustss rv = config_detach(sc->sc_child, flags);
372 1.120 augustss
373 1.47 augustss if (rv != 0)
374 1.47 augustss return (rv);
375 1.47 augustss
376 1.104 augustss usb_uncallout(sc->sc_tmo_rhsc, ohci_rhsc_enable, sc);
377 1.104 augustss
378 1.71 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
379 1.47 augustss powerhook_disestablish(sc->sc_powerhook);
380 1.59 augustss shutdownhook_disestablish(sc->sc_shutdownhook);
381 1.71 augustss #endif
382 1.59 augustss
383 1.116 augustss usb_delay_ms(&sc->sc_bus, 300); /* XXX let stray task complete */
384 1.116 augustss
385 1.47 augustss /* free data structures XXX */
386 1.47 augustss
387 1.47 augustss return (rv);
388 1.47 augustss }
389 1.55 augustss #endif
390 1.47 augustss
391 1.1 augustss ohci_soft_ed_t *
392 1.91 augustss ohci_alloc_sed(ohci_softc_t *sc)
393 1.1 augustss {
394 1.1 augustss ohci_soft_ed_t *sed;
395 1.53 augustss usbd_status err;
396 1.1 augustss int i, offs;
397 1.4 augustss usb_dma_t dma;
398 1.1 augustss
399 1.53 augustss if (sc->sc_freeeds == NULL) {
400 1.1 augustss DPRINTFN(2, ("ohci_alloc_sed: allocating chunk\n"));
401 1.53 augustss err = usb_allocmem(&sc->sc_bus, OHCI_SED_SIZE * OHCI_SED_CHUNK,
402 1.53 augustss OHCI_ED_ALIGN, &dma);
403 1.53 augustss if (err)
404 1.39 augustss return (0);
405 1.39 augustss for(i = 0; i < OHCI_SED_CHUNK; i++) {
406 1.39 augustss offs = i * OHCI_SED_SIZE;
407 1.123 augustss sed = KERNADDR(&dma, offs);
408 1.125 augustss sed->physaddr = DMAADDR(&dma, offs);
409 1.1 augustss sed->next = sc->sc_freeeds;
410 1.1 augustss sc->sc_freeeds = sed;
411 1.1 augustss }
412 1.1 augustss }
413 1.1 augustss sed = sc->sc_freeeds;
414 1.1 augustss sc->sc_freeeds = sed->next;
415 1.39 augustss memset(&sed->ed, 0, sizeof(ohci_ed_t));
416 1.1 augustss sed->next = 0;
417 1.39 augustss return (sed);
418 1.1 augustss }
419 1.1 augustss
420 1.1 augustss void
421 1.91 augustss ohci_free_sed(ohci_softc_t *sc, ohci_soft_ed_t *sed)
422 1.1 augustss {
423 1.1 augustss sed->next = sc->sc_freeeds;
424 1.1 augustss sc->sc_freeeds = sed;
425 1.1 augustss }
426 1.1 augustss
427 1.1 augustss ohci_soft_td_t *
428 1.91 augustss ohci_alloc_std(ohci_softc_t *sc)
429 1.1 augustss {
430 1.1 augustss ohci_soft_td_t *std;
431 1.53 augustss usbd_status err;
432 1.1 augustss int i, offs;
433 1.4 augustss usb_dma_t dma;
434 1.69 augustss int s;
435 1.1 augustss
436 1.53 augustss if (sc->sc_freetds == NULL) {
437 1.1 augustss DPRINTFN(2, ("ohci_alloc_std: allocating chunk\n"));
438 1.53 augustss err = usb_allocmem(&sc->sc_bus, OHCI_STD_SIZE * OHCI_STD_CHUNK,
439 1.53 augustss OHCI_TD_ALIGN, &dma);
440 1.53 augustss if (err)
441 1.83 augustss return (NULL);
442 1.69 augustss s = splusb();
443 1.39 augustss for(i = 0; i < OHCI_STD_CHUNK; i++) {
444 1.39 augustss offs = i * OHCI_STD_SIZE;
445 1.123 augustss std = KERNADDR(&dma, offs);
446 1.125 augustss std->physaddr = DMAADDR(&dma, offs);
447 1.1 augustss std->nexttd = sc->sc_freetds;
448 1.1 augustss sc->sc_freetds = std;
449 1.1 augustss }
450 1.69 augustss splx(s);
451 1.1 augustss }
452 1.69 augustss
453 1.69 augustss s = splusb();
454 1.1 augustss std = sc->sc_freetds;
455 1.1 augustss sc->sc_freetds = std->nexttd;
456 1.39 augustss memset(&std->td, 0, sizeof(ohci_td_t));
457 1.83 augustss std->nexttd = NULL;
458 1.83 augustss std->xfer = NULL;
459 1.69 augustss ohci_hash_add_td(sc, std);
460 1.69 augustss splx(s);
461 1.69 augustss
462 1.1 augustss return (std);
463 1.1 augustss }
464 1.1 augustss
465 1.1 augustss void
466 1.91 augustss ohci_free_std(ohci_softc_t *sc, ohci_soft_td_t *std)
467 1.1 augustss {
468 1.69 augustss int s;
469 1.69 augustss
470 1.69 augustss s = splusb();
471 1.69 augustss ohci_hash_rem_td(sc, std);
472 1.1 augustss std->nexttd = sc->sc_freetds;
473 1.1 augustss sc->sc_freetds = std;
474 1.69 augustss splx(s);
475 1.1 augustss }
476 1.1 augustss
477 1.1 augustss usbd_status
478 1.91 augustss ohci_alloc_std_chain(struct ohci_pipe *opipe, ohci_softc_t *sc,
479 1.91 augustss int alen, int rd, usbd_xfer_handle xfer,
480 1.91 augustss ohci_soft_td_t *sp, ohci_soft_td_t **ep)
481 1.48 augustss {
482 1.48 augustss ohci_soft_td_t *next, *cur;
483 1.48 augustss ohci_physaddr_t dataphys, dataphysend;
484 1.77 augustss u_int32_t tdflags;
485 1.75 augustss int len, curlen;
486 1.77 augustss usb_dma_t *dma = &xfer->dmabuf;
487 1.77 augustss u_int16_t flags = xfer->flags;
488 1.48 augustss
489 1.75 augustss DPRINTFN(alen < 4096,("ohci_alloc_std_chain: start len=%d\n", alen));
490 1.75 augustss
491 1.75 augustss len = alen;
492 1.48 augustss cur = sp;
493 1.125 augustss dataphys = DMAADDR(dma, 0);
494 1.48 augustss dataphysend = OHCI_PAGE(dataphys + len - 1);
495 1.168 augustss tdflags = HTOO32(
496 1.120 augustss (rd ? OHCI_TD_IN : OHCI_TD_OUT) |
497 1.77 augustss (flags & USBD_SHORT_XFER_OK ? OHCI_TD_R : 0) |
498 1.77 augustss OHCI_TD_NOCC | OHCI_TD_TOGGLE_CARRY | OHCI_TD_NOINTR);
499 1.61 augustss
500 1.48 augustss for (;;) {
501 1.48 augustss next = ohci_alloc_std(sc);
502 1.75 augustss if (next == NULL)
503 1.61 augustss goto nomem;
504 1.48 augustss
505 1.48 augustss /* The OHCI hardware can handle at most one page crossing. */
506 1.48 augustss if (OHCI_PAGE(dataphys) == dataphysend ||
507 1.48 augustss OHCI_PAGE(dataphys) + OHCI_PAGE_SIZE == dataphysend) {
508 1.48 augustss /* we can handle it in this TD */
509 1.48 augustss curlen = len;
510 1.48 augustss } else {
511 1.48 augustss /* must use multiple TDs, fill as much as possible. */
512 1.120 augustss curlen = 2 * OHCI_PAGE_SIZE -
513 1.48 augustss (dataphys & (OHCI_PAGE_SIZE-1));
514 1.78 augustss /* the length must be a multiple of the max size */
515 1.78 augustss curlen -= curlen % UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize);
516 1.78 augustss #ifdef DIAGNOSTIC
517 1.78 augustss if (curlen == 0)
518 1.128 provos panic("ohci_alloc_std: curlen == 0");
519 1.78 augustss #endif
520 1.48 augustss }
521 1.48 augustss DPRINTFN(4,("ohci_alloc_std_chain: dataphys=0x%08x "
522 1.48 augustss "dataphysend=0x%08x len=%d curlen=%d\n",
523 1.48 augustss dataphys, dataphysend,
524 1.48 augustss len, curlen));
525 1.48 augustss len -= curlen;
526 1.48 augustss
527 1.77 augustss cur->td.td_flags = tdflags;
528 1.168 augustss cur->td.td_cbp = HTOO32(dataphys);
529 1.48 augustss cur->nexttd = next;
530 1.168 augustss cur->td.td_nexttd = HTOO32(next->physaddr);
531 1.168 augustss cur->td.td_be = HTOO32(dataphys + curlen - 1);
532 1.48 augustss cur->len = curlen;
533 1.48 augustss cur->flags = OHCI_ADD_LEN;
534 1.77 augustss cur->xfer = xfer;
535 1.48 augustss DPRINTFN(10,("ohci_alloc_std_chain: cbp=0x%08x be=0x%08x\n",
536 1.48 augustss dataphys, dataphys + curlen - 1));
537 1.48 augustss if (len == 0)
538 1.48 augustss break;
539 1.48 augustss DPRINTFN(10,("ohci_alloc_std_chain: extend chain\n"));
540 1.48 augustss dataphys += curlen;
541 1.48 augustss cur = next;
542 1.48 augustss }
543 1.164 augustss if (!rd && (flags & USBD_FORCE_SHORT_XFER) &&
544 1.75 augustss alen % UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize) == 0) {
545 1.61 augustss /* Force a 0 length transfer at the end. */
546 1.75 augustss
547 1.75 augustss cur = next;
548 1.61 augustss next = ohci_alloc_std(sc);
549 1.75 augustss if (next == NULL)
550 1.61 augustss goto nomem;
551 1.61 augustss
552 1.77 augustss cur->td.td_flags = tdflags;
553 1.61 augustss cur->td.td_cbp = 0; /* indicate 0 length packet */
554 1.61 augustss cur->nexttd = next;
555 1.168 augustss cur->td.td_nexttd = HTOO32(next->physaddr);
556 1.75 augustss cur->td.td_be = ~0;
557 1.61 augustss cur->len = 0;
558 1.61 augustss cur->flags = 0;
559 1.77 augustss cur->xfer = xfer;
560 1.61 augustss DPRINTFN(2,("ohci_alloc_std_chain: add 0 xfer\n"));
561 1.61 augustss }
562 1.77 augustss *ep = cur;
563 1.48 augustss
564 1.48 augustss return (USBD_NORMAL_COMPLETION);
565 1.61 augustss
566 1.61 augustss nomem:
567 1.61 augustss /* XXX free chain */
568 1.61 augustss return (USBD_NOMEM);
569 1.48 augustss }
570 1.48 augustss
571 1.53 augustss #if 0
572 1.82 augustss Static void
573 1.120 augustss ohci_free_std_chain(ohci_softc_t *sc, ohci_soft_td_t *std,
574 1.91 augustss ohci_soft_td_t *stdend)
575 1.48 augustss {
576 1.48 augustss ohci_soft_td_t *p;
577 1.48 augustss
578 1.48 augustss for (; std != stdend; std = p) {
579 1.48 augustss p = std->nexttd;
580 1.48 augustss ohci_free_std(sc, std);
581 1.48 augustss }
582 1.48 augustss }
583 1.53 augustss #endif
584 1.48 augustss
585 1.60 augustss ohci_soft_itd_t *
586 1.91 augustss ohci_alloc_sitd(ohci_softc_t *sc)
587 1.60 augustss {
588 1.60 augustss ohci_soft_itd_t *sitd;
589 1.60 augustss usbd_status err;
590 1.83 augustss int i, s, offs;
591 1.60 augustss usb_dma_t dma;
592 1.60 augustss
593 1.60 augustss if (sc->sc_freeitds == NULL) {
594 1.60 augustss DPRINTFN(2, ("ohci_alloc_sitd: allocating chunk\n"));
595 1.83 augustss err = usb_allocmem(&sc->sc_bus, OHCI_SITD_SIZE * OHCI_SITD_CHUNK,
596 1.83 augustss OHCI_ITD_ALIGN, &dma);
597 1.60 augustss if (err)
598 1.83 augustss return (NULL);
599 1.129 augustss s = splusb();
600 1.83 augustss for(i = 0; i < OHCI_SITD_CHUNK; i++) {
601 1.83 augustss offs = i * OHCI_SITD_SIZE;
602 1.123 augustss sitd = KERNADDR(&dma, offs);
603 1.125 augustss sitd->physaddr = DMAADDR(&dma, offs);
604 1.60 augustss sitd->nextitd = sc->sc_freeitds;
605 1.60 augustss sc->sc_freeitds = sitd;
606 1.60 augustss }
607 1.129 augustss splx(s);
608 1.60 augustss }
609 1.83 augustss
610 1.83 augustss s = splusb();
611 1.60 augustss sitd = sc->sc_freeitds;
612 1.60 augustss sc->sc_freeitds = sitd->nextitd;
613 1.60 augustss memset(&sitd->itd, 0, sizeof(ohci_itd_t));
614 1.83 augustss sitd->nextitd = NULL;
615 1.83 augustss sitd->xfer = NULL;
616 1.83 augustss ohci_hash_add_itd(sc, sitd);
617 1.83 augustss splx(s);
618 1.83 augustss
619 1.83 augustss #ifdef DIAGNOSTIC
620 1.83 augustss sitd->isdone = 0;
621 1.83 augustss #endif
622 1.83 augustss
623 1.60 augustss return (sitd);
624 1.60 augustss }
625 1.60 augustss
626 1.60 augustss void
627 1.91 augustss ohci_free_sitd(ohci_softc_t *sc, ohci_soft_itd_t *sitd)
628 1.60 augustss {
629 1.83 augustss int s;
630 1.83 augustss
631 1.83 augustss DPRINTFN(10,("ohci_free_sitd: sitd=%p\n", sitd));
632 1.83 augustss
633 1.83 augustss #ifdef DIAGNOSTIC
634 1.83 augustss if (!sitd->isdone) {
635 1.128 provos panic("ohci_free_sitd: sitd=%p not done", sitd);
636 1.83 augustss return;
637 1.83 augustss }
638 1.134 toshii /* Warn double free */
639 1.134 toshii sitd->isdone = 0;
640 1.83 augustss #endif
641 1.83 augustss
642 1.83 augustss s = splusb();
643 1.83 augustss ohci_hash_rem_itd(sc, sitd);
644 1.60 augustss sitd->nextitd = sc->sc_freeitds;
645 1.60 augustss sc->sc_freeitds = sitd;
646 1.83 augustss splx(s);
647 1.60 augustss }
648 1.60 augustss
649 1.48 augustss usbd_status
650 1.91 augustss ohci_init(ohci_softc_t *sc)
651 1.1 augustss {
652 1.1 augustss ohci_soft_ed_t *sed, *psed;
653 1.53 augustss usbd_status err;
654 1.1 augustss int i;
655 1.161 augustss u_int32_t s, ctl, rwc, ival, hcr, fm, per, rev, desca, descb;
656 1.16 augustss
657 1.1 augustss DPRINTF(("ohci_init: start\n"));
658 1.36 augustss #if defined(__OpenBSD__)
659 1.55 augustss printf(",");
660 1.36 augustss #else
661 1.55 augustss printf("%s:", USBDEVNAME(sc->sc_bus.bdev));
662 1.36 augustss #endif
663 1.56 augustss rev = OREAD4(sc, OHCI_REVISION);
664 1.55 augustss printf(" OHCI version %d.%d%s\n", OHCI_REV_HI(rev), OHCI_REV_LO(rev),
665 1.1 augustss OHCI_REV_LEGACY(rev) ? ", legacy support" : "");
666 1.55 augustss
667 1.1 augustss if (OHCI_REV_HI(rev) != 1 || OHCI_REV_LO(rev) != 0) {
668 1.120 augustss printf("%s: unsupported OHCI revision\n",
669 1.15 augustss USBDEVNAME(sc->sc_bus.bdev));
670 1.56 augustss sc->sc_bus.usbrev = USBREV_UNKNOWN;
671 1.1 augustss return (USBD_INVAL);
672 1.1 augustss }
673 1.56 augustss sc->sc_bus.usbrev = USBREV_1_0;
674 1.1 augustss
675 1.1 augustss for (i = 0; i < OHCI_HASH_SIZE; i++)
676 1.1 augustss LIST_INIT(&sc->sc_hash_tds[i]);
677 1.83 augustss for (i = 0; i < OHCI_HASH_SIZE; i++)
678 1.83 augustss LIST_INIT(&sc->sc_hash_itds[i]);
679 1.1 augustss
680 1.62 augustss SIMPLEQ_INIT(&sc->sc_free_xfers);
681 1.62 augustss
682 1.153 fvdl #ifdef __NetBSD__
683 1.153 fvdl usb_setup_reserve(sc, &sc->sc_dma_reserve, sc->sc_bus.dmatag,
684 1.153 fvdl USB_MEM_RESERVE);
685 1.153 fvdl #endif
686 1.153 fvdl
687 1.73 augustss /* XXX determine alignment by R/W */
688 1.1 augustss /* Allocate the HCCA area. */
689 1.120 augustss err = usb_allocmem(&sc->sc_bus, OHCI_HCCA_SIZE,
690 1.4 augustss OHCI_HCCA_ALIGN, &sc->sc_hccadma);
691 1.53 augustss if (err)
692 1.53 augustss return (err);
693 1.123 augustss sc->sc_hcca = KERNADDR(&sc->sc_hccadma, 0);
694 1.1 augustss memset(sc->sc_hcca, 0, OHCI_HCCA_SIZE);
695 1.1 augustss
696 1.1 augustss sc->sc_eintrs = OHCI_NORMAL_INTRS;
697 1.1 augustss
698 1.60 augustss /* Allocate dummy ED that starts the control list. */
699 1.1 augustss sc->sc_ctrl_head = ohci_alloc_sed(sc);
700 1.53 augustss if (sc->sc_ctrl_head == NULL) {
701 1.53 augustss err = USBD_NOMEM;
702 1.1 augustss goto bad1;
703 1.1 augustss }
704 1.168 augustss sc->sc_ctrl_head->ed.ed_flags |= HTOO32(OHCI_ED_SKIP);
705 1.34 augustss
706 1.60 augustss /* Allocate dummy ED that starts the bulk list. */
707 1.1 augustss sc->sc_bulk_head = ohci_alloc_sed(sc);
708 1.53 augustss if (sc->sc_bulk_head == NULL) {
709 1.53 augustss err = USBD_NOMEM;
710 1.1 augustss goto bad2;
711 1.1 augustss }
712 1.168 augustss sc->sc_bulk_head->ed.ed_flags |= HTOO32(OHCI_ED_SKIP);
713 1.1 augustss
714 1.60 augustss /* Allocate dummy ED that starts the isochronous list. */
715 1.60 augustss sc->sc_isoc_head = ohci_alloc_sed(sc);
716 1.60 augustss if (sc->sc_isoc_head == NULL) {
717 1.60 augustss err = USBD_NOMEM;
718 1.60 augustss goto bad3;
719 1.60 augustss }
720 1.168 augustss sc->sc_isoc_head->ed.ed_flags |= HTOO32(OHCI_ED_SKIP);
721 1.60 augustss
722 1.1 augustss /* Allocate all the dummy EDs that make up the interrupt tree. */
723 1.1 augustss for (i = 0; i < OHCI_NO_EDS; i++) {
724 1.1 augustss sed = ohci_alloc_sed(sc);
725 1.53 augustss if (sed == NULL) {
726 1.1 augustss while (--i >= 0)
727 1.1 augustss ohci_free_sed(sc, sc->sc_eds[i]);
728 1.53 augustss err = USBD_NOMEM;
729 1.60 augustss goto bad4;
730 1.1 augustss }
731 1.1 augustss /* All ED fields are set to 0. */
732 1.1 augustss sc->sc_eds[i] = sed;
733 1.168 augustss sed->ed.ed_flags |= HTOO32(OHCI_ED_SKIP);
734 1.60 augustss if (i != 0)
735 1.1 augustss psed = sc->sc_eds[(i-1) / 2];
736 1.60 augustss else
737 1.60 augustss psed= sc->sc_isoc_head;
738 1.60 augustss sed->next = psed;
739 1.168 augustss sed->ed.ed_nexted = HTOO32(psed->physaddr);
740 1.1 augustss }
741 1.120 augustss /*
742 1.1 augustss * Fill HCCA interrupt table. The bit reversal is to get
743 1.1 augustss * the tree set up properly to spread the interrupts.
744 1.1 augustss */
745 1.1 augustss for (i = 0; i < OHCI_NO_INTRS; i++)
746 1.120 augustss sc->sc_hcca->hcca_interrupt_table[revbits[i]] =
747 1.168 augustss HTOO32(sc->sc_eds[OHCI_NO_EDS-OHCI_NO_INTRS+i]->physaddr);
748 1.1 augustss
749 1.73 augustss #ifdef OHCI_DEBUG
750 1.73 augustss if (ohcidebug > 15) {
751 1.73 augustss for (i = 0; i < OHCI_NO_EDS; i++) {
752 1.73 augustss printf("ed#%d ", i);
753 1.168 augustss ohci_dump_ed(sc, sc->sc_eds[i]);
754 1.73 augustss }
755 1.73 augustss printf("iso ");
756 1.168 augustss ohci_dump_ed(sc, sc->sc_isoc_head);
757 1.73 augustss }
758 1.73 augustss #endif
759 1.73 augustss
760 1.161 augustss /* Preserve values programmed by SMM/BIOS but lost over reset. */
761 1.161 augustss ctl = OREAD4(sc, OHCI_CONTROL);
762 1.161 augustss rwc = ctl & OHCI_RWC;
763 1.161 augustss fm = OREAD4(sc, OHCI_FM_INTERVAL);
764 1.161 augustss desca = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
765 1.161 augustss descb = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
766 1.161 augustss
767 1.1 augustss /* Determine in what context we are running. */
768 1.1 augustss if (ctl & OHCI_IR) {
769 1.1 augustss /* SMM active, request change */
770 1.1 augustss DPRINTF(("ohci_init: SMM active, request owner change\n"));
771 1.160 augustss if ((sc->sc_intre & (OHCI_OC | OHCI_MIE)) ==
772 1.160 augustss (OHCI_OC | OHCI_MIE))
773 1.160 augustss OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_MIE);
774 1.1 augustss s = OREAD4(sc, OHCI_COMMAND_STATUS);
775 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, s | OHCI_OCR);
776 1.1 augustss for (i = 0; i < 100 && (ctl & OHCI_IR); i++) {
777 1.53 augustss usb_delay_ms(&sc->sc_bus, 1);
778 1.1 augustss ctl = OREAD4(sc, OHCI_CONTROL);
779 1.1 augustss }
780 1.160 augustss OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_MIE);
781 1.1 augustss if ((ctl & OHCI_IR) == 0) {
782 1.15 augustss printf("%s: SMM does not respond, resetting\n",
783 1.15 augustss USBDEVNAME(sc->sc_bus.bdev));
784 1.161 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET | rwc);
785 1.1 augustss goto reset;
786 1.1 augustss }
787 1.103 augustss #if 0
788 1.103 augustss /* Don't bother trying to reuse the BIOS init, we'll reset it anyway. */
789 1.1 augustss } else if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_RESET) {
790 1.1 augustss /* BIOS started controller. */
791 1.1 augustss DPRINTF(("ohci_init: BIOS active\n"));
792 1.1 augustss if ((ctl & OHCI_HCFS_MASK) != OHCI_HCFS_OPERATIONAL) {
793 1.161 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_OPERATIONAL | rwc);
794 1.53 augustss usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
795 1.1 augustss }
796 1.103 augustss #endif
797 1.1 augustss } else {
798 1.1 augustss DPRINTF(("ohci_init: cold started\n"));
799 1.1 augustss reset:
800 1.1 augustss /* Controller was cold started. */
801 1.53 augustss usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY);
802 1.1 augustss }
803 1.1 augustss
804 1.16 augustss /*
805 1.25 augustss * This reset should not be necessary according to the OHCI spec, but
806 1.25 augustss * without it some controllers do not start.
807 1.16 augustss */
808 1.16 augustss DPRINTF(("%s: resetting\n", USBDEVNAME(sc->sc_bus.bdev)));
809 1.161 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET | rwc);
810 1.55 augustss usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY);
811 1.16 augustss
812 1.1 augustss /* We now own the host controller and the bus has been reset. */
813 1.1 augustss
814 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_HCR); /* Reset HC */
815 1.1 augustss /* Nominal time for a reset is 10 us. */
816 1.1 augustss for (i = 0; i < 10; i++) {
817 1.1 augustss delay(10);
818 1.1 augustss hcr = OREAD4(sc, OHCI_COMMAND_STATUS) & OHCI_HCR;
819 1.1 augustss if (!hcr)
820 1.1 augustss break;
821 1.1 augustss }
822 1.1 augustss if (hcr) {
823 1.15 augustss printf("%s: reset timeout\n", USBDEVNAME(sc->sc_bus.bdev));
824 1.53 augustss err = USBD_IOERROR;
825 1.60 augustss goto bad5;
826 1.1 augustss }
827 1.52 augustss #ifdef OHCI_DEBUG
828 1.1 augustss if (ohcidebug > 15)
829 1.1 augustss ohci_dumpregs(sc);
830 1.1 augustss #endif
831 1.1 augustss
832 1.60 augustss /* The controller is now in SUSPEND state, we have 2ms to finish. */
833 1.1 augustss
834 1.1 augustss /* Set up HC registers. */
835 1.125 augustss OWRITE4(sc, OHCI_HCCA, DMAADDR(&sc->sc_hccadma, 0));
836 1.1 augustss OWRITE4(sc, OHCI_CONTROL_HEAD_ED, sc->sc_ctrl_head->physaddr);
837 1.1 augustss OWRITE4(sc, OHCI_BULK_HEAD_ED, sc->sc_bulk_head->physaddr);
838 1.55 augustss /* disable all interrupts and then switch on all desired interrupts */
839 1.1 augustss OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_ALL_INTRS);
840 1.55 augustss /* switch on desired functional features */
841 1.1 augustss ctl = OREAD4(sc, OHCI_CONTROL);
842 1.1 augustss ctl &= ~(OHCI_CBSR_MASK | OHCI_LES | OHCI_HCFS_MASK | OHCI_IR);
843 1.1 augustss ctl |= OHCI_PLE | OHCI_IE | OHCI_CLE | OHCI_BLE |
844 1.161 augustss OHCI_RATIO_1_4 | OHCI_HCFS_OPERATIONAL | rwc;
845 1.1 augustss /* And finally start it! */
846 1.1 augustss OWRITE4(sc, OHCI_CONTROL, ctl);
847 1.1 augustss
848 1.1 augustss /*
849 1.1 augustss * The controller is now OPERATIONAL. Set a some final
850 1.1 augustss * registers that should be set earlier, but that the
851 1.1 augustss * controller ignores when in the SUSPEND state.
852 1.1 augustss */
853 1.161 augustss ival = OHCI_GET_IVAL(fm);
854 1.1 augustss fm = (OREAD4(sc, OHCI_FM_INTERVAL) & OHCI_FIT) ^ OHCI_FIT;
855 1.1 augustss fm |= OHCI_FSMPS(ival) | ival;
856 1.1 augustss OWRITE4(sc, OHCI_FM_INTERVAL, fm);
857 1.1 augustss per = OHCI_PERIODIC(ival); /* 90% periodic */
858 1.1 augustss OWRITE4(sc, OHCI_PERIODIC_START, per);
859 1.1 augustss
860 1.68 augustss /* Fiddle the No OverCurrent Protection bit to avoid chip bug. */
861 1.68 augustss OWRITE4(sc, OHCI_RH_DESCRIPTOR_A, desca | OHCI_NOCP);
862 1.68 augustss OWRITE4(sc, OHCI_RH_STATUS, OHCI_LPSC); /* Enable port power */
863 1.85 augustss usb_delay_ms(&sc->sc_bus, OHCI_ENABLE_POWER_DELAY);
864 1.68 augustss OWRITE4(sc, OHCI_RH_DESCRIPTOR_A, desca);
865 1.1 augustss
866 1.85 augustss /*
867 1.85 augustss * The AMD756 requires a delay before re-reading the register,
868 1.85 augustss * otherwise it will occasionally report 0 ports.
869 1.85 augustss */
870 1.145 augustss sc->sc_noport = 0;
871 1.145 augustss for (i = 0; i < 10 && sc->sc_noport == 0; i++) {
872 1.145 augustss usb_delay_ms(&sc->sc_bus, OHCI_READ_DESC_DELAY);
873 1.145 augustss sc->sc_noport = OHCI_GET_NDP(OREAD4(sc, OHCI_RH_DESCRIPTOR_A));
874 1.145 augustss }
875 1.1 augustss
876 1.52 augustss #ifdef OHCI_DEBUG
877 1.1 augustss if (ohcidebug > 5)
878 1.1 augustss ohci_dumpregs(sc);
879 1.1 augustss #endif
880 1.120 augustss
881 1.1 augustss /* Set up the bus struct. */
882 1.42 augustss sc->sc_bus.methods = &ohci_bus_methods;
883 1.1 augustss sc->sc_bus.pipe_size = sizeof(struct ohci_pipe);
884 1.1 augustss
885 1.71 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
886 1.101 minoura sc->sc_control = sc->sc_intre = 0;
887 1.47 augustss sc->sc_powerhook = powerhook_establish(ohci_power, sc);
888 1.59 augustss sc->sc_shutdownhook = shutdownhook_establish(ohci_shutdown, sc);
889 1.71 augustss #endif
890 1.59 augustss
891 1.104 augustss usb_callout_init(sc->sc_tmo_rhsc);
892 1.104 augustss
893 1.167 augustss /* Finally, turn on interrupts. */
894 1.167 augustss DPRINTFN(1,("ohci_init: enabling\n"));
895 1.167 augustss OWRITE4(sc, OHCI_INTERRUPT_ENABLE, sc->sc_eintrs | OHCI_MIE);
896 1.167 augustss
897 1.1 augustss return (USBD_NORMAL_COMPLETION);
898 1.1 augustss
899 1.60 augustss bad5:
900 1.60 augustss for (i = 0; i < OHCI_NO_EDS; i++)
901 1.60 augustss ohci_free_sed(sc, sc->sc_eds[i]);
902 1.60 augustss bad4:
903 1.60 augustss ohci_free_sed(sc, sc->sc_isoc_head);
904 1.1 augustss bad3:
905 1.144 augustss ohci_free_sed(sc, sc->sc_bulk_head);
906 1.144 augustss bad2:
907 1.1 augustss ohci_free_sed(sc, sc->sc_ctrl_head);
908 1.1 augustss bad1:
909 1.44 augustss usb_freemem(&sc->sc_bus, &sc->sc_hccadma);
910 1.53 augustss return (err);
911 1.1 augustss }
912 1.1 augustss
913 1.42 augustss usbd_status
914 1.91 augustss ohci_allocm(struct usbd_bus *bus, usb_dma_t *dma, u_int32_t size)
915 1.42 augustss {
916 1.52 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
917 1.42 augustss struct ohci_softc *sc = (struct ohci_softc *)bus;
918 1.52 augustss #endif
919 1.153 fvdl usbd_status status;
920 1.42 augustss
921 1.153 fvdl status = usb_allocmem(&sc->sc_bus, size, 0, dma);
922 1.153 fvdl #ifdef __NetBSD__
923 1.153 fvdl if (status == USBD_NOMEM)
924 1.153 fvdl status = usb_reserve_allocm(&sc->sc_dma_reserve, dma, size);
925 1.153 fvdl #endif
926 1.153 fvdl return status;
927 1.42 augustss }
928 1.42 augustss
929 1.42 augustss void
930 1.91 augustss ohci_freem(struct usbd_bus *bus, usb_dma_t *dma)
931 1.42 augustss {
932 1.52 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
933 1.42 augustss struct ohci_softc *sc = (struct ohci_softc *)bus;
934 1.52 augustss #endif
935 1.153 fvdl #ifdef __NetBSD__
936 1.153 fvdl if (dma->block->flags & USB_DMA_RESERVE) {
937 1.153 fvdl usb_reserve_freem(&((struct ohci_softc *)bus)->sc_dma_reserve,
938 1.153 fvdl dma);
939 1.153 fvdl return;
940 1.153 fvdl }
941 1.153 fvdl #endif
942 1.44 augustss usb_freemem(&sc->sc_bus, dma);
943 1.62 augustss }
944 1.62 augustss
945 1.62 augustss usbd_xfer_handle
946 1.91 augustss ohci_allocx(struct usbd_bus *bus)
947 1.62 augustss {
948 1.62 augustss struct ohci_softc *sc = (struct ohci_softc *)bus;
949 1.62 augustss usbd_xfer_handle xfer;
950 1.62 augustss
951 1.62 augustss xfer = SIMPLEQ_FIRST(&sc->sc_free_xfers);
952 1.118 augustss if (xfer != NULL) {
953 1.126 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_free_xfers, next);
954 1.118 augustss #ifdef DIAGNOSTIC
955 1.118 augustss if (xfer->busy_free != XFER_FREE) {
956 1.118 augustss printf("ohci_allocx: xfer=%p not free, 0x%08x\n", xfer,
957 1.118 augustss xfer->busy_free);
958 1.118 augustss }
959 1.118 augustss #endif
960 1.118 augustss } else {
961 1.114 augustss xfer = malloc(sizeof(struct ohci_xfer), M_USB, M_NOWAIT);
962 1.118 augustss }
963 1.118 augustss if (xfer != NULL) {
964 1.114 augustss memset(xfer, 0, sizeof (struct ohci_xfer));
965 1.118 augustss #ifdef DIAGNOSTIC
966 1.118 augustss xfer->busy_free = XFER_BUSY;
967 1.118 augustss #endif
968 1.118 augustss }
969 1.62 augustss return (xfer);
970 1.62 augustss }
971 1.62 augustss
972 1.62 augustss void
973 1.91 augustss ohci_freex(struct usbd_bus *bus, usbd_xfer_handle xfer)
974 1.62 augustss {
975 1.62 augustss struct ohci_softc *sc = (struct ohci_softc *)bus;
976 1.62 augustss
977 1.118 augustss #ifdef DIAGNOSTIC
978 1.118 augustss if (xfer->busy_free != XFER_BUSY) {
979 1.118 augustss printf("ohci_freex: xfer=%p not busy, 0x%08x\n", xfer,
980 1.118 augustss xfer->busy_free);
981 1.118 augustss return;
982 1.118 augustss }
983 1.118 augustss xfer->busy_free = XFER_FREE;
984 1.118 augustss #endif
985 1.62 augustss SIMPLEQ_INSERT_HEAD(&sc->sc_free_xfers, xfer, next);
986 1.42 augustss }
987 1.42 augustss
988 1.59 augustss /*
989 1.59 augustss * Shut down the controller when the system is going down.
990 1.59 augustss */
991 1.59 augustss void
992 1.91 augustss ohci_shutdown(void *v)
993 1.59 augustss {
994 1.59 augustss ohci_softc_t *sc = v;
995 1.59 augustss
996 1.59 augustss DPRINTF(("ohci_shutdown: stopping the HC\n"));
997 1.59 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
998 1.59 augustss }
999 1.59 augustss
1000 1.59 augustss /*
1001 1.59 augustss * Handle suspend/resume.
1002 1.59 augustss *
1003 1.59 augustss * We need to switch to polling mode here, because this routine is
1004 1.162 augustss * called from an interupt context. This is all right since we
1005 1.59 augustss * are almost suspended anyway.
1006 1.59 augustss */
1007 1.33 augustss void
1008 1.91 augustss ohci_power(int why, void *v)
1009 1.33 augustss {
1010 1.33 augustss ohci_softc_t *sc = v;
1011 1.97 augustss u_int32_t ctl;
1012 1.95 augustss int s;
1013 1.33 augustss
1014 1.95 augustss #ifdef OHCI_DEBUG
1015 1.41 augustss DPRINTF(("ohci_power: sc=%p, why=%d\n", sc, why));
1016 1.33 augustss ohci_dumpregs(sc);
1017 1.33 augustss #endif
1018 1.95 augustss
1019 1.98 augustss s = splhardusb();
1020 1.95 augustss switch (why) {
1021 1.95 augustss case PWR_SUSPEND:
1022 1.95 augustss case PWR_STANDBY:
1023 1.97 augustss sc->sc_bus.use_polling++;
1024 1.101 minoura ctl = OREAD4(sc, OHCI_CONTROL) & ~OHCI_HCFS_MASK;
1025 1.101 minoura if (sc->sc_control == 0) {
1026 1.101 minoura /*
1027 1.101 minoura * Preserve register values, in case that APM BIOS
1028 1.101 minoura * does not recover them.
1029 1.101 minoura */
1030 1.101 minoura sc->sc_control = ctl;
1031 1.101 minoura sc->sc_intre = OREAD4(sc, OHCI_INTERRUPT_ENABLE);
1032 1.101 minoura }
1033 1.101 minoura ctl |= OHCI_HCFS_SUSPEND;
1034 1.97 augustss OWRITE4(sc, OHCI_CONTROL, ctl);
1035 1.97 augustss usb_delay_ms(&sc->sc_bus, USB_RESUME_WAIT);
1036 1.97 augustss sc->sc_bus.use_polling--;
1037 1.95 augustss break;
1038 1.95 augustss case PWR_RESUME:
1039 1.97 augustss sc->sc_bus.use_polling++;
1040 1.101 minoura /* Some broken BIOSes do not recover these values */
1041 1.125 augustss OWRITE4(sc, OHCI_HCCA, DMAADDR(&sc->sc_hccadma, 0));
1042 1.101 minoura OWRITE4(sc, OHCI_CONTROL_HEAD_ED, sc->sc_ctrl_head->physaddr);
1043 1.101 minoura OWRITE4(sc, OHCI_BULK_HEAD_ED, sc->sc_bulk_head->physaddr);
1044 1.101 minoura if (sc->sc_intre)
1045 1.101 minoura OWRITE4(sc, OHCI_INTERRUPT_ENABLE,
1046 1.101 minoura sc->sc_intre & (OHCI_ALL_INTRS | OHCI_MIE));
1047 1.101 minoura if (sc->sc_control)
1048 1.101 minoura ctl = sc->sc_control;
1049 1.101 minoura else
1050 1.101 minoura ctl = OREAD4(sc, OHCI_CONTROL);
1051 1.101 minoura ctl |= OHCI_HCFS_RESUME;
1052 1.97 augustss OWRITE4(sc, OHCI_CONTROL, ctl);
1053 1.97 augustss usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
1054 1.97 augustss ctl = (ctl & ~OHCI_HCFS_MASK) | OHCI_HCFS_OPERATIONAL;
1055 1.97 augustss OWRITE4(sc, OHCI_CONTROL, ctl);
1056 1.97 augustss usb_delay_ms(&sc->sc_bus, USB_RESUME_RECOVERY);
1057 1.101 minoura sc->sc_control = sc->sc_intre = 0;
1058 1.97 augustss sc->sc_bus.use_polling--;
1059 1.95 augustss break;
1060 1.95 augustss case PWR_SOFTSUSPEND:
1061 1.95 augustss case PWR_SOFTSTANDBY:
1062 1.95 augustss case PWR_SOFTRESUME:
1063 1.95 augustss break;
1064 1.95 augustss }
1065 1.95 augustss splx(s);
1066 1.33 augustss }
1067 1.33 augustss
1068 1.52 augustss #ifdef OHCI_DEBUG
1069 1.1 augustss void
1070 1.91 augustss ohci_dumpregs(ohci_softc_t *sc)
1071 1.1 augustss {
1072 1.41 augustss DPRINTF(("ohci_dumpregs: rev=0x%08x control=0x%08x command=0x%08x\n",
1073 1.41 augustss OREAD4(sc, OHCI_REVISION),
1074 1.41 augustss OREAD4(sc, OHCI_CONTROL),
1075 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
1076 1.41 augustss DPRINTF((" intrstat=0x%08x intre=0x%08x intrd=0x%08x\n",
1077 1.41 augustss OREAD4(sc, OHCI_INTERRUPT_STATUS),
1078 1.41 augustss OREAD4(sc, OHCI_INTERRUPT_ENABLE),
1079 1.41 augustss OREAD4(sc, OHCI_INTERRUPT_DISABLE)));
1080 1.41 augustss DPRINTF((" hcca=0x%08x percur=0x%08x ctrlhd=0x%08x\n",
1081 1.41 augustss OREAD4(sc, OHCI_HCCA),
1082 1.41 augustss OREAD4(sc, OHCI_PERIOD_CURRENT_ED),
1083 1.41 augustss OREAD4(sc, OHCI_CONTROL_HEAD_ED)));
1084 1.41 augustss DPRINTF((" ctrlcur=0x%08x bulkhd=0x%08x bulkcur=0x%08x\n",
1085 1.41 augustss OREAD4(sc, OHCI_CONTROL_CURRENT_ED),
1086 1.41 augustss OREAD4(sc, OHCI_BULK_HEAD_ED),
1087 1.41 augustss OREAD4(sc, OHCI_BULK_CURRENT_ED)));
1088 1.41 augustss DPRINTF((" done=0x%08x fmival=0x%08x fmrem=0x%08x\n",
1089 1.41 augustss OREAD4(sc, OHCI_DONE_HEAD),
1090 1.41 augustss OREAD4(sc, OHCI_FM_INTERVAL),
1091 1.41 augustss OREAD4(sc, OHCI_FM_REMAINING)));
1092 1.41 augustss DPRINTF((" fmnum=0x%08x perst=0x%08x lsthrs=0x%08x\n",
1093 1.41 augustss OREAD4(sc, OHCI_FM_NUMBER),
1094 1.41 augustss OREAD4(sc, OHCI_PERIODIC_START),
1095 1.41 augustss OREAD4(sc, OHCI_LS_THRESHOLD)));
1096 1.41 augustss DPRINTF((" desca=0x%08x descb=0x%08x stat=0x%08x\n",
1097 1.41 augustss OREAD4(sc, OHCI_RH_DESCRIPTOR_A),
1098 1.41 augustss OREAD4(sc, OHCI_RH_DESCRIPTOR_B),
1099 1.41 augustss OREAD4(sc, OHCI_RH_STATUS)));
1100 1.41 augustss DPRINTF((" port1=0x%08x port2=0x%08x\n",
1101 1.41 augustss OREAD4(sc, OHCI_RH_PORT_STATUS(1)),
1102 1.41 augustss OREAD4(sc, OHCI_RH_PORT_STATUS(2))));
1103 1.41 augustss DPRINTF((" HCCA: frame_number=0x%04x done_head=0x%08x\n",
1104 1.168 augustss O32TOH(sc->sc_hcca->hcca_frame_number),
1105 1.168 augustss O32TOH(sc->sc_hcca->hcca_done_head)));
1106 1.1 augustss }
1107 1.1 augustss #endif
1108 1.1 augustss
1109 1.91 augustss Static int ohci_intr1(ohci_softc_t *);
1110 1.53 augustss
1111 1.1 augustss int
1112 1.91 augustss ohci_intr(void *p)
1113 1.1 augustss {
1114 1.1 augustss ohci_softc_t *sc = p;
1115 1.111 augustss
1116 1.116 augustss if (sc == NULL || sc->sc_dying)
1117 1.111 augustss return (0);
1118 1.53 augustss
1119 1.53 augustss /* If we get an interrupt while polling, then just ignore it. */
1120 1.57 augustss if (sc->sc_bus.use_polling) {
1121 1.57 augustss #ifdef DIAGNOSTIC
1122 1.149 mycroft DPRINTFN(16, ("ohci_intr: ignored interrupt while polling\n"));
1123 1.57 augustss #endif
1124 1.154 joff /* for level triggered intrs, should do something to ack */
1125 1.155 perry OWRITE4(sc, OHCI_INTERRUPT_STATUS,
1126 1.154 joff OREAD4(sc, OHCI_INTERRUPT_STATUS));
1127 1.155 perry
1128 1.53 augustss return (0);
1129 1.57 augustss }
1130 1.53 augustss
1131 1.120 augustss return (ohci_intr1(sc));
1132 1.53 augustss }
1133 1.53 augustss
1134 1.82 augustss Static int
1135 1.91 augustss ohci_intr1(ohci_softc_t *sc)
1136 1.53 augustss {
1137 1.1 augustss u_int32_t intrs, eintrs;
1138 1.1 augustss
1139 1.105 augustss DPRINTFN(14,("ohci_intr1: enter\n"));
1140 1.105 augustss
1141 1.15 augustss /* In case the interrupt occurs before initialization has completed. */
1142 1.34 augustss if (sc == NULL || sc->sc_hcca == NULL) {
1143 1.15 augustss #ifdef DIAGNOSTIC
1144 1.15 augustss printf("ohci_intr: sc->sc_hcca == NULL\n");
1145 1.15 augustss #endif
1146 1.15 augustss return (0);
1147 1.15 augustss }
1148 1.15 augustss
1149 1.157 mycroft intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS);
1150 1.1 augustss if (!intrs)
1151 1.1 augustss return (0);
1152 1.55 augustss
1153 1.157 mycroft OWRITE4(sc, OHCI_INTERRUPT_STATUS, intrs & ~(OHCI_MIE|OHCI_WDH)); /* Acknowledge */
1154 1.1 augustss eintrs = intrs & sc->sc_eintrs;
1155 1.1 augustss if (!eintrs)
1156 1.1 augustss return (0);
1157 1.1 augustss
1158 1.45 augustss sc->sc_bus.intr_context++;
1159 1.44 augustss sc->sc_bus.no_intrs++;
1160 1.120 augustss DPRINTFN(7, ("ohci_intr: sc=%p intrs=0x%x(0x%x) eintrs=0x%x\n",
1161 1.1 augustss sc, (u_int)intrs, OREAD4(sc, OHCI_INTERRUPT_STATUS),
1162 1.1 augustss (u_int)eintrs));
1163 1.1 augustss
1164 1.1 augustss if (eintrs & OHCI_SO) {
1165 1.100 augustss sc->sc_overrun_cnt++;
1166 1.100 augustss if (usbd_ratecheck(&sc->sc_overrun_ntc)) {
1167 1.100 augustss printf("%s: %u scheduling overruns\n",
1168 1.100 augustss USBDEVNAME(sc->sc_bus.bdev), sc->sc_overrun_cnt);
1169 1.100 augustss sc->sc_overrun_cnt = 0;
1170 1.100 augustss }
1171 1.1 augustss /* XXX do what */
1172 1.106 augustss eintrs &= ~OHCI_SO;
1173 1.1 augustss }
1174 1.1 augustss if (eintrs & OHCI_WDH) {
1175 1.157 mycroft /*
1176 1.157 mycroft * We block the interrupt below, and reenable it later from
1177 1.157 mycroft * ohci_softintr().
1178 1.157 mycroft */
1179 1.72 augustss usb_schedsoftintr(&sc->sc_bus);
1180 1.1 augustss }
1181 1.1 augustss if (eintrs & OHCI_RD) {
1182 1.33 augustss printf("%s: resume detect\n", USBDEVNAME(sc->sc_bus.bdev));
1183 1.1 augustss /* XXX process resume detect */
1184 1.1 augustss }
1185 1.1 augustss if (eintrs & OHCI_UE) {
1186 1.15 augustss printf("%s: unrecoverable error, controller halted\n",
1187 1.15 augustss USBDEVNAME(sc->sc_bus.bdev));
1188 1.1 augustss OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET);
1189 1.1 augustss /* XXX what else */
1190 1.1 augustss }
1191 1.1 augustss if (eintrs & OHCI_RHSC) {
1192 1.120 augustss /*
1193 1.157 mycroft * We block the interrupt below, and reenable it later from
1194 1.157 mycroft * a timeout.
1195 1.1 augustss */
1196 1.157 mycroft ohci_rhsc(sc, sc->sc_intrxfer);
1197 1.104 augustss /* Do not allow RHSC interrupts > 1 per second */
1198 1.104 augustss usb_callout(sc->sc_tmo_rhsc, hz, ohci_rhsc_enable, sc);
1199 1.1 augustss }
1200 1.1 augustss
1201 1.45 augustss sc->sc_bus.intr_context--;
1202 1.44 augustss
1203 1.106 augustss if (eintrs != 0) {
1204 1.157 mycroft /* Block unprocessed interrupts. */
1205 1.106 augustss OWRITE4(sc, OHCI_INTERRUPT_DISABLE, eintrs);
1206 1.106 augustss sc->sc_eintrs &= ~eintrs;
1207 1.157 mycroft DPRINTFN(1, ("%s: blocking intrs 0x%x\n",
1208 1.157 mycroft USBDEVNAME(sc->sc_bus.bdev), eintrs));
1209 1.106 augustss }
1210 1.1 augustss
1211 1.1 augustss return (1);
1212 1.1 augustss }
1213 1.1 augustss
1214 1.1 augustss void
1215 1.104 augustss ohci_rhsc_enable(void *v_sc)
1216 1.104 augustss {
1217 1.104 augustss ohci_softc_t *sc = v_sc;
1218 1.129 augustss int s;
1219 1.104 augustss
1220 1.129 augustss s = splhardusb();
1221 1.157 mycroft sc->sc_eintrs |= OHCI_RHSC;
1222 1.157 mycroft OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_RHSC);
1223 1.129 augustss splx(s);
1224 1.1 augustss }
1225 1.1 augustss
1226 1.52 augustss #ifdef OHCI_DEBUG
1227 1.166 drochner const char *ohci_cc_strs[] = {
1228 1.13 augustss "NO_ERROR",
1229 1.13 augustss "CRC",
1230 1.13 augustss "BIT_STUFFING",
1231 1.13 augustss "DATA_TOGGLE_MISMATCH",
1232 1.13 augustss "STALL",
1233 1.13 augustss "DEVICE_NOT_RESPONDING",
1234 1.13 augustss "PID_CHECK_FAILURE",
1235 1.13 augustss "UNEXPECTED_PID",
1236 1.13 augustss "DATA_OVERRUN",
1237 1.13 augustss "DATA_UNDERRUN",
1238 1.13 augustss "BUFFER_OVERRUN",
1239 1.13 augustss "BUFFER_UNDERRUN",
1240 1.67 augustss "reserved",
1241 1.67 augustss "reserved",
1242 1.67 augustss "NOT_ACCESSED",
1243 1.13 augustss "NOT_ACCESSED",
1244 1.13 augustss };
1245 1.13 augustss #endif
1246 1.13 augustss
1247 1.1 augustss void
1248 1.157 mycroft ohci_softintr(void *v)
1249 1.83 augustss {
1250 1.157 mycroft ohci_softc_t *sc = v;
1251 1.157 mycroft ohci_soft_itd_t *sitd, *sidone, *sitdnext;
1252 1.157 mycroft ohci_soft_td_t *std, *sdone, *stdnext;
1253 1.157 mycroft usbd_xfer_handle xfer;
1254 1.157 mycroft struct ohci_pipe *opipe;
1255 1.157 mycroft int len, cc, s;
1256 1.157 mycroft int i, j, actlen, iframes, uedir;
1257 1.157 mycroft ohci_physaddr_t done;
1258 1.157 mycroft
1259 1.157 mycroft DPRINTFN(10,("ohci_softintr: enter\n"));
1260 1.157 mycroft
1261 1.157 mycroft sc->sc_bus.intr_context++;
1262 1.157 mycroft
1263 1.157 mycroft s = splhardusb();
1264 1.168 augustss done = O32TOH(sc->sc_hcca->hcca_done_head) & ~OHCI_DONE_INTRS;
1265 1.157 mycroft sc->sc_hcca->hcca_done_head = 0;
1266 1.157 mycroft OWRITE4(sc, OHCI_INTERRUPT_STATUS, OHCI_WDH);
1267 1.157 mycroft sc->sc_eintrs |= OHCI_WDH;
1268 1.157 mycroft OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_WDH);
1269 1.157 mycroft splx(s);
1270 1.83 augustss
1271 1.83 augustss /* Reverse the done list. */
1272 1.83 augustss for (sdone = NULL, sidone = NULL; done != 0; ) {
1273 1.83 augustss std = ohci_hash_find_td(sc, done);
1274 1.83 augustss if (std != NULL) {
1275 1.83 augustss std->dnext = sdone;
1276 1.168 augustss done = O32TOH(std->td.td_nexttd);
1277 1.83 augustss sdone = std;
1278 1.83 augustss DPRINTFN(10,("add TD %p\n", std));
1279 1.83 augustss continue;
1280 1.83 augustss }
1281 1.83 augustss sitd = ohci_hash_find_itd(sc, done);
1282 1.83 augustss if (sitd != NULL) {
1283 1.83 augustss sitd->dnext = sidone;
1284 1.168 augustss done = O32TOH(sitd->itd.itd_nextitd);
1285 1.83 augustss sidone = sitd;
1286 1.83 augustss DPRINTFN(5,("add ITD %p\n", sitd));
1287 1.83 augustss continue;
1288 1.83 augustss }
1289 1.157 mycroft panic("ohci_softintr: addr 0x%08lx not found", (u_long)done);
1290 1.83 augustss }
1291 1.83 augustss
1292 1.105 augustss DPRINTFN(10,("ohci_softintr: sdone=%p sidone=%p\n", sdone, sidone));
1293 1.1 augustss
1294 1.52 augustss #ifdef OHCI_DEBUG
1295 1.1 augustss if (ohcidebug > 10) {
1296 1.41 augustss DPRINTF(("ohci_process_done: TD done:\n"));
1297 1.168 augustss ohci_dump_tds(sc, sdone);
1298 1.1 augustss }
1299 1.1 augustss #endif
1300 1.1 augustss
1301 1.48 augustss for (std = sdone; std; std = stdnext) {
1302 1.53 augustss xfer = std->xfer;
1303 1.48 augustss stdnext = std->dnext;
1304 1.53 augustss DPRINTFN(10, ("ohci_process_done: std=%p xfer=%p hcpriv=%p\n",
1305 1.69 augustss std, xfer, xfer ? xfer->hcpriv : 0));
1306 1.71 augustss if (xfer == NULL) {
1307 1.117 augustss /*
1308 1.117 augustss * xfer == NULL: There seems to be no xfer associated
1309 1.71 augustss * with this TD. It is tailp that happened to end up on
1310 1.71 augustss * the done queue.
1311 1.117 augustss * Shouldn't happen, but some chips are broken(?).
1312 1.71 augustss */
1313 1.71 augustss continue;
1314 1.71 augustss }
1315 1.53 augustss if (xfer->status == USBD_CANCELLED ||
1316 1.53 augustss xfer->status == USBD_TIMEOUT) {
1317 1.34 augustss DPRINTF(("ohci_process_done: cancel/timeout %p\n",
1318 1.53 augustss xfer));
1319 1.38 augustss /* Handled by abort routine. */
1320 1.83 augustss continue;
1321 1.83 augustss }
1322 1.83 augustss usb_uncallout(xfer->timeout_handle, ohci_timeout, xfer);
1323 1.141 mycroft
1324 1.141 mycroft len = std->len;
1325 1.141 mycroft if (std->td.td_cbp != 0)
1326 1.168 augustss len -= O32TOH(std->td.td_be) -
1327 1.168 augustss O32TOH(std->td.td_cbp) + 1;
1328 1.141 mycroft DPRINTFN(10, ("ohci_process_done: len=%d, flags=0x%x\n", len,
1329 1.141 mycroft std->flags));
1330 1.141 mycroft if (std->flags & OHCI_ADD_LEN)
1331 1.141 mycroft xfer->actlen += len;
1332 1.141 mycroft
1333 1.168 augustss cc = OHCI_TD_GET_CC(O32TOH(std->td.td_flags));
1334 1.83 augustss if (cc == OHCI_CC_NO_ERROR) {
1335 1.34 augustss if (std->flags & OHCI_CALL_DONE) {
1336 1.53 augustss xfer->status = USBD_NORMAL_COMPLETION;
1337 1.133 toshii s = splusb();
1338 1.53 augustss usb_transfer_complete(xfer);
1339 1.133 toshii splx(s);
1340 1.21 augustss }
1341 1.48 augustss ohci_free_std(sc, std);
1342 1.1 augustss } else {
1343 1.48 augustss /*
1344 1.48 augustss * Endpoint is halted. First unlink all the TDs
1345 1.48 augustss * belonging to the failed transfer, and then restart
1346 1.48 augustss * the endpoint.
1347 1.48 augustss */
1348 1.1 augustss ohci_soft_td_t *p, *n;
1349 1.134 toshii opipe = (struct ohci_pipe *)xfer->pipe;
1350 1.48 augustss
1351 1.71 augustss DPRINTFN(15,("ohci_process_done: error cc=%d (%s)\n",
1352 1.168 augustss OHCI_TD_GET_CC(O32TOH(std->td.td_flags)),
1353 1.168 augustss ohci_cc_strs[OHCI_TD_GET_CC(O32TOH(std->td.td_flags))]));
1354 1.48 augustss
1355 1.48 augustss /* remove TDs */
1356 1.53 augustss for (p = std; p->xfer == xfer; p = n) {
1357 1.1 augustss n = p->nexttd;
1358 1.1 augustss ohci_free_std(sc, p);
1359 1.1 augustss }
1360 1.48 augustss
1361 1.16 augustss /* clear halt */
1362 1.168 augustss opipe->sed->ed.ed_headp = HTOO32(p->physaddr);
1363 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
1364 1.48 augustss
1365 1.1 augustss if (cc == OHCI_CC_STALL)
1366 1.53 augustss xfer->status = USBD_STALLED;
1367 1.1 augustss else
1368 1.53 augustss xfer->status = USBD_IOERROR;
1369 1.133 toshii s = splusb();
1370 1.53 augustss usb_transfer_complete(xfer);
1371 1.133 toshii splx(s);
1372 1.1 augustss }
1373 1.1 augustss }
1374 1.72 augustss
1375 1.83 augustss #ifdef OHCI_DEBUG
1376 1.83 augustss if (ohcidebug > 10) {
1377 1.105 augustss DPRINTF(("ohci_softintr: ITD done:\n"));
1378 1.168 augustss ohci_dump_itds(sc, sidone);
1379 1.83 augustss }
1380 1.83 augustss #endif
1381 1.83 augustss
1382 1.83 augustss for (sitd = sidone; sitd != NULL; sitd = sitdnext) {
1383 1.83 augustss xfer = sitd->xfer;
1384 1.83 augustss sitdnext = sitd->dnext;
1385 1.83 augustss DPRINTFN(1, ("ohci_process_done: sitd=%p xfer=%p hcpriv=%p\n",
1386 1.83 augustss sitd, xfer, xfer ? xfer->hcpriv : 0));
1387 1.83 augustss if (xfer == NULL)
1388 1.83 augustss continue;
1389 1.83 augustss if (xfer->status == USBD_CANCELLED ||
1390 1.83 augustss xfer->status == USBD_TIMEOUT) {
1391 1.83 augustss DPRINTF(("ohci_process_done: cancel/timeout %p\n",
1392 1.83 augustss xfer));
1393 1.83 augustss /* Handled by abort routine. */
1394 1.83 augustss continue;
1395 1.83 augustss }
1396 1.83 augustss #ifdef DIAGNOSTIC
1397 1.83 augustss if (sitd->isdone)
1398 1.83 augustss printf("ohci_softintr: sitd=%p is done\n", sitd);
1399 1.83 augustss sitd->isdone = 1;
1400 1.83 augustss #endif
1401 1.134 toshii if (sitd->flags & OHCI_CALL_DONE) {
1402 1.134 toshii ohci_soft_itd_t *next;
1403 1.134 toshii
1404 1.134 toshii opipe = (struct ohci_pipe *)xfer->pipe;
1405 1.134 toshii opipe->u.iso.inuse -= xfer->nframes;
1406 1.134 toshii uedir = UE_GET_DIR(xfer->pipe->endpoint->edesc->
1407 1.134 toshii bEndpointAddress);
1408 1.134 toshii xfer->status = USBD_NORMAL_COMPLETION;
1409 1.134 toshii actlen = 0;
1410 1.137 simonb for (i = 0, sitd = xfer->hcpriv;;
1411 1.134 toshii sitd = next) {
1412 1.134 toshii next = sitd->nextitd;
1413 1.168 augustss if (OHCI_ITD_GET_CC(O32TOH(sitd->
1414 1.135 toshii itd.itd_flags)) != OHCI_CC_NO_ERROR)
1415 1.134 toshii xfer->status = USBD_IOERROR;
1416 1.134 toshii /* For input, update frlengths with actual */
1417 1.134 toshii /* XXX anything necessary for output? */
1418 1.134 toshii if (uedir == UE_DIR_IN &&
1419 1.134 toshii xfer->status == USBD_NORMAL_COMPLETION) {
1420 1.168 augustss iframes = OHCI_ITD_GET_FC(O32TOH(
1421 1.135 toshii sitd->itd.itd_flags));
1422 1.134 toshii for (j = 0; j < iframes; i++, j++) {
1423 1.168 augustss len = O16TOH(sitd->
1424 1.134 toshii itd.itd_offset[j]);
1425 1.158 toshii if ((OHCI_ITD_PSW_GET_CC(len) &
1426 1.158 toshii OHCI_CC_NOT_ACCESSED_MASK)
1427 1.158 toshii == OHCI_CC_NOT_ACCESSED)
1428 1.158 toshii len = 0;
1429 1.158 toshii else
1430 1.158 toshii len = OHCI_ITD_PSW_LENGTH(len);
1431 1.134 toshii xfer->frlengths[i] = len;
1432 1.134 toshii actlen += len;
1433 1.134 toshii }
1434 1.134 toshii }
1435 1.134 toshii if (sitd->flags & OHCI_CALL_DONE)
1436 1.134 toshii break;
1437 1.134 toshii ohci_free_sitd(sc, sitd);
1438 1.83 augustss }
1439 1.134 toshii ohci_free_sitd(sc, sitd);
1440 1.134 toshii if (uedir == UE_DIR_IN &&
1441 1.134 toshii xfer->status == USBD_NORMAL_COMPLETION)
1442 1.134 toshii xfer->actlen = actlen;
1443 1.151 mycroft xfer->hcpriv = NULL;
1444 1.134 toshii
1445 1.134 toshii s = splusb();
1446 1.83 augustss usb_transfer_complete(xfer);
1447 1.134 toshii splx(s);
1448 1.83 augustss }
1449 1.83 augustss }
1450 1.83 augustss
1451 1.131 augustss #ifdef USB_USE_SOFTINTR
1452 1.119 augustss if (sc->sc_softwake) {
1453 1.119 augustss sc->sc_softwake = 0;
1454 1.119 augustss wakeup(&sc->sc_softwake);
1455 1.119 augustss }
1456 1.131 augustss #endif /* USB_USE_SOFTINTR */
1457 1.119 augustss
1458 1.72 augustss sc->sc_bus.intr_context--;
1459 1.105 augustss DPRINTFN(10,("ohci_softintr: done:\n"));
1460 1.1 augustss }
1461 1.1 augustss
1462 1.1 augustss void
1463 1.91 augustss ohci_device_ctrl_done(usbd_xfer_handle xfer)
1464 1.1 augustss {
1465 1.140 gson DPRINTFN(10,("ohci_device_ctrl_done: xfer=%p\n", xfer));
1466 1.1 augustss
1467 1.38 augustss #ifdef DIAGNOSTIC
1468 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST)) {
1469 1.140 gson panic("ohci_device_ctrl_done: not a request");
1470 1.1 augustss }
1471 1.38 augustss #endif
1472 1.1 augustss }
1473 1.1 augustss
1474 1.1 augustss void
1475 1.91 augustss ohci_device_intr_done(usbd_xfer_handle xfer)
1476 1.1 augustss {
1477 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1478 1.38 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
1479 1.1 augustss ohci_soft_ed_t *sed = opipe->sed;
1480 1.48 augustss ohci_soft_td_t *data, *tail;
1481 1.1 augustss
1482 1.1 augustss
1483 1.140 gson DPRINTFN(10,("ohci_device_intr_done: xfer=%p, actlen=%d\n",
1484 1.53 augustss xfer, xfer->actlen));
1485 1.1 augustss
1486 1.53 augustss if (xfer->pipe->repeat) {
1487 1.60 augustss data = opipe->tail.td;
1488 1.1 augustss tail = ohci_alloc_std(sc); /* XXX should reuse TD */
1489 1.53 augustss if (tail == NULL) {
1490 1.53 augustss xfer->status = USBD_NOMEM;
1491 1.1 augustss return;
1492 1.1 augustss }
1493 1.55 augustss tail->xfer = NULL;
1494 1.120 augustss
1495 1.168 augustss data->td.td_flags = HTOO32(
1496 1.120 augustss OHCI_TD_IN | OHCI_TD_NOCC |
1497 1.16 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
1498 1.53 augustss if (xfer->flags & USBD_SHORT_XFER_OK)
1499 1.168 augustss data->td.td_flags |= HTOO32(OHCI_TD_R);
1500 1.168 augustss data->td.td_cbp = HTOO32(DMAADDR(&xfer->dmabuf, 0));
1501 1.48 augustss data->nexttd = tail;
1502 1.168 augustss data->td.td_nexttd = HTOO32(tail->physaddr);
1503 1.168 augustss data->td.td_be = HTOO32(O32TOH(data->td.td_cbp) +
1504 1.76 tsutsui xfer->length - 1);
1505 1.53 augustss data->len = xfer->length;
1506 1.53 augustss data->xfer = xfer;
1507 1.48 augustss data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
1508 1.53 augustss xfer->hcpriv = data;
1509 1.53 augustss xfer->actlen = 0;
1510 1.1 augustss
1511 1.168 augustss sed->ed.ed_tailp = HTOO32(tail->physaddr);
1512 1.60 augustss opipe->tail.td = tail;
1513 1.1 augustss }
1514 1.1 augustss }
1515 1.1 augustss
1516 1.1 augustss void
1517 1.91 augustss ohci_device_bulk_done(usbd_xfer_handle xfer)
1518 1.3 augustss {
1519 1.140 gson DPRINTFN(10,("ohci_device_bulk_done: xfer=%p, actlen=%d\n",
1520 1.53 augustss xfer, xfer->actlen));
1521 1.3 augustss }
1522 1.3 augustss
1523 1.3 augustss void
1524 1.91 augustss ohci_rhsc(ohci_softc_t *sc, usbd_xfer_handle xfer)
1525 1.1 augustss {
1526 1.1 augustss usbd_pipe_handle pipe;
1527 1.1 augustss u_char *p;
1528 1.1 augustss int i, m;
1529 1.1 augustss int hstatus;
1530 1.1 augustss
1531 1.1 augustss hstatus = OREAD4(sc, OHCI_RH_STATUS);
1532 1.120 augustss DPRINTF(("ohci_rhsc: sc=%p xfer=%p hstatus=0x%08x\n",
1533 1.53 augustss sc, xfer, hstatus));
1534 1.1 augustss
1535 1.53 augustss if (xfer == NULL) {
1536 1.1 augustss /* Just ignore the change. */
1537 1.1 augustss return;
1538 1.1 augustss }
1539 1.1 augustss
1540 1.53 augustss pipe = xfer->pipe;
1541 1.1 augustss
1542 1.123 augustss p = KERNADDR(&xfer->dmabuf, 0);
1543 1.53 augustss m = min(sc->sc_noport, xfer->length * 8 - 1);
1544 1.53 augustss memset(p, 0, xfer->length);
1545 1.1 augustss for (i = 1; i <= m; i++) {
1546 1.87 augustss /* Pick out CHANGE bits from the status reg. */
1547 1.1 augustss if (OREAD4(sc, OHCI_RH_PORT_STATUS(i)) >> 16)
1548 1.1 augustss p[i/8] |= 1 << (i%8);
1549 1.1 augustss }
1550 1.1 augustss DPRINTF(("ohci_rhsc: change=0x%02x\n", *p));
1551 1.53 augustss xfer->actlen = xfer->length;
1552 1.53 augustss xfer->status = USBD_NORMAL_COMPLETION;
1553 1.1 augustss
1554 1.53 augustss usb_transfer_complete(xfer);
1555 1.38 augustss }
1556 1.38 augustss
1557 1.38 augustss void
1558 1.91 augustss ohci_root_intr_done(usbd_xfer_handle xfer)
1559 1.65 augustss {
1560 1.65 augustss }
1561 1.65 augustss
1562 1.65 augustss void
1563 1.91 augustss ohci_root_ctrl_done(usbd_xfer_handle xfer)
1564 1.38 augustss {
1565 1.1 augustss }
1566 1.1 augustss
1567 1.1 augustss /*
1568 1.1 augustss * Wait here until controller claims to have an interrupt.
1569 1.1 augustss * Then call ohci_intr and return. Use timeout to avoid waiting
1570 1.1 augustss * too long.
1571 1.1 augustss */
1572 1.1 augustss void
1573 1.91 augustss ohci_waitintr(ohci_softc_t *sc, usbd_xfer_handle xfer)
1574 1.1 augustss {
1575 1.163 augustss int timo;
1576 1.1 augustss u_int32_t intrs;
1577 1.1 augustss
1578 1.53 augustss xfer->status = USBD_IN_PROGRESS;
1579 1.163 augustss for (timo = xfer->timeout; timo >= 0; timo--) {
1580 1.20 augustss usb_delay_ms(&sc->sc_bus, 1);
1581 1.116 augustss if (sc->sc_dying)
1582 1.116 augustss break;
1583 1.1 augustss intrs = OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs;
1584 1.27 augustss DPRINTFN(15,("ohci_waitintr: 0x%04x\n", intrs));
1585 1.52 augustss #ifdef OHCI_DEBUG
1586 1.1 augustss if (ohcidebug > 15)
1587 1.1 augustss ohci_dumpregs(sc);
1588 1.1 augustss #endif
1589 1.1 augustss if (intrs) {
1590 1.53 augustss ohci_intr1(sc);
1591 1.53 augustss if (xfer->status != USBD_IN_PROGRESS)
1592 1.1 augustss return;
1593 1.1 augustss }
1594 1.1 augustss }
1595 1.15 augustss
1596 1.15 augustss /* Timeout */
1597 1.1 augustss DPRINTF(("ohci_waitintr: timeout\n"));
1598 1.53 augustss xfer->status = USBD_TIMEOUT;
1599 1.53 augustss usb_transfer_complete(xfer);
1600 1.15 augustss /* XXX should free TD */
1601 1.5 augustss }
1602 1.5 augustss
1603 1.5 augustss void
1604 1.91 augustss ohci_poll(struct usbd_bus *bus)
1605 1.5 augustss {
1606 1.5 augustss ohci_softc_t *sc = (ohci_softc_t *)bus;
1607 1.105 augustss #ifdef OHCI_DEBUG
1608 1.105 augustss static int last;
1609 1.105 augustss int new;
1610 1.105 augustss new = OREAD4(sc, OHCI_INTERRUPT_STATUS);
1611 1.105 augustss if (new != last) {
1612 1.105 augustss DPRINTFN(10,("ohci_poll: intrs=0x%04x\n", new));
1613 1.105 augustss last = new;
1614 1.105 augustss }
1615 1.105 augustss #endif
1616 1.5 augustss
1617 1.5 augustss if (OREAD4(sc, OHCI_INTERRUPT_STATUS) & sc->sc_eintrs)
1618 1.53 augustss ohci_intr1(sc);
1619 1.1 augustss }
1620 1.1 augustss
1621 1.1 augustss usbd_status
1622 1.91 augustss ohci_device_request(usbd_xfer_handle xfer)
1623 1.1 augustss {
1624 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
1625 1.53 augustss usb_device_request_t *req = &xfer->request;
1626 1.1 augustss usbd_device_handle dev = opipe->pipe.device;
1627 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1628 1.1 augustss int addr = dev->address;
1629 1.77 augustss ohci_soft_td_t *setup, *stat, *next, *tail;
1630 1.1 augustss ohci_soft_ed_t *sed;
1631 1.1 augustss int isread;
1632 1.1 augustss int len;
1633 1.53 augustss usbd_status err;
1634 1.1 augustss int s;
1635 1.1 augustss
1636 1.1 augustss isread = req->bmRequestType & UT_READ;
1637 1.1 augustss len = UGETW(req->wLength);
1638 1.1 augustss
1639 1.14 augustss DPRINTFN(3,("ohci_device_control type=0x%02x, request=0x%02x, "
1640 1.14 augustss "wValue=0x%04x, wIndex=0x%04x len=%d, addr=%d, endpt=%d\n",
1641 1.1 augustss req->bmRequestType, req->bRequest, UGETW(req->wValue),
1642 1.120 augustss UGETW(req->wIndex), len, addr,
1643 1.1 augustss opipe->pipe.endpoint->edesc->bEndpointAddress));
1644 1.1 augustss
1645 1.60 augustss setup = opipe->tail.td;
1646 1.1 augustss stat = ohci_alloc_std(sc);
1647 1.53 augustss if (stat == NULL) {
1648 1.53 augustss err = USBD_NOMEM;
1649 1.1 augustss goto bad1;
1650 1.1 augustss }
1651 1.1 augustss tail = ohci_alloc_std(sc);
1652 1.53 augustss if (tail == NULL) {
1653 1.53 augustss err = USBD_NOMEM;
1654 1.1 augustss goto bad2;
1655 1.1 augustss }
1656 1.55 augustss tail->xfer = NULL;
1657 1.1 augustss
1658 1.1 augustss sed = opipe->sed;
1659 1.1 augustss opipe->u.ctl.length = len;
1660 1.1 augustss
1661 1.148 mycroft /* Update device address and length since they may have changed
1662 1.148 mycroft during the setup of the control pipe in usbd_new_device(). */
1663 1.10 augustss /* XXX This only needs to be done once, but it's too early in open. */
1664 1.77 augustss /* XXXX Should not touch ED here! */
1665 1.168 augustss sed->ed.ed_flags = HTOO32(
1666 1.168 augustss (O32TOH(sed->ed.ed_flags) & ~(OHCI_ED_ADDRMASK | OHCI_ED_MAXPMASK)) |
1667 1.16 augustss OHCI_ED_SET_FA(addr) |
1668 1.16 augustss OHCI_ED_SET_MAXP(UGETW(opipe->pipe.endpoint->edesc->wMaxPacketSize)));
1669 1.1 augustss
1670 1.77 augustss next = stat;
1671 1.77 augustss
1672 1.1 augustss /* Set up data transaction */
1673 1.1 augustss if (len != 0) {
1674 1.77 augustss ohci_soft_td_t *std = stat;
1675 1.77 augustss
1676 1.77 augustss err = ohci_alloc_std_chain(opipe, sc, len, isread, xfer,
1677 1.77 augustss std, &stat);
1678 1.77 augustss stat = stat->nexttd; /* point at free TD */
1679 1.77 augustss if (err)
1680 1.1 augustss goto bad3;
1681 1.77 augustss /* Start toggle at 1 and then use the carried toggle. */
1682 1.168 augustss std->td.td_flags &= HTOO32(~OHCI_TD_TOGGLE_MASK);
1683 1.168 augustss std->td.td_flags |= HTOO32(OHCI_TD_TOGGLE_1);
1684 1.34 augustss }
1685 1.1 augustss
1686 1.123 augustss memcpy(KERNADDR(&opipe->u.ctl.reqdma, 0), req, sizeof *req);
1687 1.1 augustss
1688 1.168 augustss setup->td.td_flags = HTOO32(OHCI_TD_SETUP | OHCI_TD_NOCC |
1689 1.76 tsutsui OHCI_TD_TOGGLE_0 | OHCI_TD_NOINTR);
1690 1.168 augustss setup->td.td_cbp = HTOO32(DMAADDR(&opipe->u.ctl.reqdma, 0));
1691 1.1 augustss setup->nexttd = next;
1692 1.168 augustss setup->td.td_nexttd = HTOO32(next->physaddr);
1693 1.168 augustss setup->td.td_be = HTOO32(O32TOH(setup->td.td_cbp) + sizeof *req - 1);
1694 1.77 augustss setup->len = 0;
1695 1.53 augustss setup->xfer = xfer;
1696 1.34 augustss setup->flags = 0;
1697 1.53 augustss xfer->hcpriv = setup;
1698 1.1 augustss
1699 1.168 augustss stat->td.td_flags = HTOO32(
1700 1.77 augustss (isread ? OHCI_TD_OUT : OHCI_TD_IN) |
1701 1.77 augustss OHCI_TD_NOCC | OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1));
1702 1.39 augustss stat->td.td_cbp = 0;
1703 1.1 augustss stat->nexttd = tail;
1704 1.168 augustss stat->td.td_nexttd = HTOO32(tail->physaddr);
1705 1.39 augustss stat->td.td_be = 0;
1706 1.77 augustss stat->flags = OHCI_CALL_DONE;
1707 1.1 augustss stat->len = 0;
1708 1.53 augustss stat->xfer = xfer;
1709 1.1 augustss
1710 1.52 augustss #ifdef OHCI_DEBUG
1711 1.1 augustss if (ohcidebug > 5) {
1712 1.41 augustss DPRINTF(("ohci_device_request:\n"));
1713 1.168 augustss ohci_dump_ed(sc, sed);
1714 1.168 augustss ohci_dump_tds(sc, setup);
1715 1.1 augustss }
1716 1.1 augustss #endif
1717 1.1 augustss
1718 1.1 augustss /* Insert ED in schedule */
1719 1.1 augustss s = splusb();
1720 1.168 augustss sed->ed.ed_tailp = HTOO32(tail->physaddr);
1721 1.60 augustss opipe->tail.td = tail;
1722 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
1723 1.53 augustss if (xfer->timeout && !sc->sc_bus.use_polling) {
1724 1.139 tsutsui usb_callout(xfer->timeout_handle, mstohz(xfer->timeout),
1725 1.80 augustss ohci_timeout, xfer);
1726 1.15 augustss }
1727 1.1 augustss splx(s);
1728 1.1 augustss
1729 1.115 itojun #ifdef OHCI_DEBUG
1730 1.113 augustss if (ohcidebug > 20) {
1731 1.77 augustss delay(10000);
1732 1.41 augustss DPRINTF(("ohci_device_request: status=%x\n",
1733 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
1734 1.113 augustss ohci_dumpregs(sc);
1735 1.113 augustss printf("ctrl head:\n");
1736 1.168 augustss ohci_dump_ed(sc, sc->sc_ctrl_head);
1737 1.113 augustss printf("sed:\n");
1738 1.168 augustss ohci_dump_ed(sc, sed);
1739 1.168 augustss ohci_dump_tds(sc, setup);
1740 1.1 augustss }
1741 1.1 augustss #endif
1742 1.1 augustss
1743 1.1 augustss return (USBD_NORMAL_COMPLETION);
1744 1.1 augustss
1745 1.1 augustss bad3:
1746 1.1 augustss ohci_free_std(sc, tail);
1747 1.1 augustss bad2:
1748 1.1 augustss ohci_free_std(sc, stat);
1749 1.1 augustss bad1:
1750 1.53 augustss return (err);
1751 1.1 augustss }
1752 1.1 augustss
1753 1.1 augustss /*
1754 1.1 augustss * Add an ED to the schedule. Called at splusb().
1755 1.1 augustss */
1756 1.1 augustss void
1757 1.168 augustss ohci_add_ed(ohci_softc_t *sc, ohci_soft_ed_t *sed, ohci_soft_ed_t *head)
1758 1.1 augustss {
1759 1.113 augustss DPRINTFN(8,("ohci_add_ed: sed=%p head=%p\n", sed, head));
1760 1.113 augustss
1761 1.46 augustss SPLUSBCHECK;
1762 1.1 augustss sed->next = head->next;
1763 1.39 augustss sed->ed.ed_nexted = head->ed.ed_nexted;
1764 1.1 augustss head->next = sed;
1765 1.168 augustss head->ed.ed_nexted = HTOO32(sed->physaddr);
1766 1.1 augustss }
1767 1.1 augustss
1768 1.1 augustss /*
1769 1.3 augustss * Remove an ED from the schedule. Called at splusb().
1770 1.3 augustss */
1771 1.3 augustss void
1772 1.91 augustss ohci_rem_ed(ohci_soft_ed_t *sed, ohci_soft_ed_t *head)
1773 1.3 augustss {
1774 1.120 augustss ohci_soft_ed_t *p;
1775 1.3 augustss
1776 1.46 augustss SPLUSBCHECK;
1777 1.46 augustss
1778 1.3 augustss /* XXX */
1779 1.133 toshii for (p = head; p != NULL && p->next != sed; p = p->next)
1780 1.3 augustss ;
1781 1.55 augustss if (p == NULL)
1782 1.128 provos panic("ohci_rem_ed: ED not found");
1783 1.3 augustss p->next = sed->next;
1784 1.39 augustss p->ed.ed_nexted = sed->ed.ed_nexted;
1785 1.3 augustss }
1786 1.3 augustss
1787 1.3 augustss /*
1788 1.1 augustss * When a transfer is completed the TD is added to the done queue by
1789 1.1 augustss * the host controller. This queue is the processed by software.
1790 1.1 augustss * Unfortunately the queue contains the physical address of the TD
1791 1.9 augustss * and we have no simple way to translate this back to a kernel address.
1792 1.1 augustss * To make the translation possible (and fast) we use a hash table of
1793 1.1 augustss * TDs currently in the schedule. The physical address is used as the
1794 1.1 augustss * hash value.
1795 1.1 augustss */
1796 1.1 augustss
1797 1.1 augustss #define HASH(a) (((a) >> 4) % OHCI_HASH_SIZE)
1798 1.1 augustss /* Called at splusb() */
1799 1.1 augustss void
1800 1.91 augustss ohci_hash_add_td(ohci_softc_t *sc, ohci_soft_td_t *std)
1801 1.1 augustss {
1802 1.1 augustss int h = HASH(std->physaddr);
1803 1.1 augustss
1804 1.46 augustss SPLUSBCHECK;
1805 1.46 augustss
1806 1.1 augustss LIST_INSERT_HEAD(&sc->sc_hash_tds[h], std, hnext);
1807 1.1 augustss }
1808 1.1 augustss
1809 1.1 augustss /* Called at splusb() */
1810 1.1 augustss void
1811 1.91 augustss ohci_hash_rem_td(ohci_softc_t *sc, ohci_soft_td_t *std)
1812 1.1 augustss {
1813 1.46 augustss SPLUSBCHECK;
1814 1.46 augustss
1815 1.1 augustss LIST_REMOVE(std, hnext);
1816 1.1 augustss }
1817 1.1 augustss
1818 1.1 augustss ohci_soft_td_t *
1819 1.91 augustss ohci_hash_find_td(ohci_softc_t *sc, ohci_physaddr_t a)
1820 1.1 augustss {
1821 1.1 augustss int h = HASH(a);
1822 1.1 augustss ohci_soft_td_t *std;
1823 1.1 augustss
1824 1.120 augustss for (std = LIST_FIRST(&sc->sc_hash_tds[h]);
1825 1.53 augustss std != NULL;
1826 1.1 augustss std = LIST_NEXT(std, hnext))
1827 1.1 augustss if (std->physaddr == a)
1828 1.1 augustss return (std);
1829 1.83 augustss return (NULL);
1830 1.83 augustss }
1831 1.83 augustss
1832 1.83 augustss /* Called at splusb() */
1833 1.83 augustss void
1834 1.91 augustss ohci_hash_add_itd(ohci_softc_t *sc, ohci_soft_itd_t *sitd)
1835 1.83 augustss {
1836 1.83 augustss int h = HASH(sitd->physaddr);
1837 1.83 augustss
1838 1.83 augustss SPLUSBCHECK;
1839 1.83 augustss
1840 1.120 augustss DPRINTFN(10,("ohci_hash_add_itd: sitd=%p physaddr=0x%08lx\n",
1841 1.83 augustss sitd, (u_long)sitd->physaddr));
1842 1.83 augustss
1843 1.83 augustss LIST_INSERT_HEAD(&sc->sc_hash_itds[h], sitd, hnext);
1844 1.83 augustss }
1845 1.83 augustss
1846 1.83 augustss /* Called at splusb() */
1847 1.83 augustss void
1848 1.91 augustss ohci_hash_rem_itd(ohci_softc_t *sc, ohci_soft_itd_t *sitd)
1849 1.83 augustss {
1850 1.83 augustss SPLUSBCHECK;
1851 1.83 augustss
1852 1.120 augustss DPRINTFN(10,("ohci_hash_rem_itd: sitd=%p physaddr=0x%08lx\n",
1853 1.83 augustss sitd, (u_long)sitd->physaddr));
1854 1.83 augustss
1855 1.83 augustss LIST_REMOVE(sitd, hnext);
1856 1.83 augustss }
1857 1.83 augustss
1858 1.83 augustss ohci_soft_itd_t *
1859 1.91 augustss ohci_hash_find_itd(ohci_softc_t *sc, ohci_physaddr_t a)
1860 1.83 augustss {
1861 1.83 augustss int h = HASH(a);
1862 1.83 augustss ohci_soft_itd_t *sitd;
1863 1.83 augustss
1864 1.120 augustss for (sitd = LIST_FIRST(&sc->sc_hash_itds[h]);
1865 1.83 augustss sitd != NULL;
1866 1.83 augustss sitd = LIST_NEXT(sitd, hnext))
1867 1.83 augustss if (sitd->physaddr == a)
1868 1.83 augustss return (sitd);
1869 1.83 augustss return (NULL);
1870 1.1 augustss }
1871 1.1 augustss
1872 1.1 augustss void
1873 1.91 augustss ohci_timeout(void *addr)
1874 1.1 augustss {
1875 1.114 augustss struct ohci_xfer *oxfer = addr;
1876 1.116 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)oxfer->xfer.pipe;
1877 1.116 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
1878 1.114 augustss
1879 1.114 augustss DPRINTF(("ohci_timeout: oxfer=%p\n", oxfer));
1880 1.114 augustss
1881 1.116 augustss if (sc->sc_dying) {
1882 1.116 augustss ohci_abort_xfer(&oxfer->xfer, USBD_TIMEOUT);
1883 1.116 augustss return;
1884 1.116 augustss }
1885 1.116 augustss
1886 1.114 augustss /* Execute the abort in a process context. */
1887 1.114 augustss usb_init_task(&oxfer->abort_task, ohci_timeout_task, addr);
1888 1.114 augustss usb_add_task(oxfer->xfer.pipe->device, &oxfer->abort_task);
1889 1.114 augustss }
1890 1.114 augustss
1891 1.114 augustss void
1892 1.114 augustss ohci_timeout_task(void *addr)
1893 1.114 augustss {
1894 1.53 augustss usbd_xfer_handle xfer = addr;
1895 1.48 augustss int s;
1896 1.1 augustss
1897 1.114 augustss DPRINTF(("ohci_timeout_task: xfer=%p\n", xfer));
1898 1.45 augustss
1899 1.48 augustss s = splusb();
1900 1.54 augustss ohci_abort_xfer(xfer, USBD_TIMEOUT);
1901 1.48 augustss splx(s);
1902 1.1 augustss }
1903 1.1 augustss
1904 1.52 augustss #ifdef OHCI_DEBUG
1905 1.1 augustss void
1906 1.168 augustss ohci_dump_tds(ohci_softc_t *sc, ohci_soft_td_t *std)
1907 1.1 augustss {
1908 1.1 augustss for (; std; std = std->nexttd)
1909 1.168 augustss ohci_dump_td(sc, std);
1910 1.1 augustss }
1911 1.1 augustss
1912 1.1 augustss void
1913 1.168 augustss ohci_dump_td(ohci_softc_t *sc, ohci_soft_td_t *std)
1914 1.1 augustss {
1915 1.92 tv char sbuf[128];
1916 1.92 tv
1917 1.168 augustss bitmask_snprintf((u_int32_t)O32TOH(std->td.td_flags),
1918 1.92 tv "\20\23R\24OUT\25IN\31TOG1\32SETTOGGLE",
1919 1.92 tv sbuf, sizeof(sbuf));
1920 1.92 tv
1921 1.107 augustss printf("TD(%p) at %08lx: %s delay=%d ec=%d cc=%d\ncbp=0x%08lx "
1922 1.120 augustss "nexttd=0x%08lx be=0x%08lx\n",
1923 1.107 augustss std, (u_long)std->physaddr, sbuf,
1924 1.168 augustss OHCI_TD_GET_DI(O32TOH(std->td.td_flags)),
1925 1.168 augustss OHCI_TD_GET_EC(O32TOH(std->td.td_flags)),
1926 1.168 augustss OHCI_TD_GET_CC(O32TOH(std->td.td_flags)),
1927 1.168 augustss (u_long)O32TOH(std->td.td_cbp),
1928 1.168 augustss (u_long)O32TOH(std->td.td_nexttd),
1929 1.168 augustss (u_long)O32TOH(std->td.td_be));
1930 1.1 augustss }
1931 1.1 augustss
1932 1.1 augustss void
1933 1.168 augustss ohci_dump_itd(ohci_softc_t *sc, ohci_soft_itd_t *sitd)
1934 1.83 augustss {
1935 1.83 augustss int i;
1936 1.83 augustss
1937 1.107 augustss printf("ITD(%p) at %08lx: sf=%d di=%d fc=%d cc=%d\n"
1938 1.120 augustss "bp0=0x%08lx next=0x%08lx be=0x%08lx\n",
1939 1.107 augustss sitd, (u_long)sitd->physaddr,
1940 1.168 augustss OHCI_ITD_GET_SF(O32TOH(sitd->itd.itd_flags)),
1941 1.168 augustss OHCI_ITD_GET_DI(O32TOH(sitd->itd.itd_flags)),
1942 1.168 augustss OHCI_ITD_GET_FC(O32TOH(sitd->itd.itd_flags)),
1943 1.168 augustss OHCI_ITD_GET_CC(O32TOH(sitd->itd.itd_flags)),
1944 1.168 augustss (u_long)O32TOH(sitd->itd.itd_bp0),
1945 1.168 augustss (u_long)O32TOH(sitd->itd.itd_nextitd),
1946 1.168 augustss (u_long)O32TOH(sitd->itd.itd_be));
1947 1.83 augustss for (i = 0; i < OHCI_ITD_NOFFSET; i++)
1948 1.107 augustss printf("offs[%d]=0x%04x ", i,
1949 1.168 augustss (u_int)O16TOH(sitd->itd.itd_offset[i]));
1950 1.107 augustss printf("\n");
1951 1.83 augustss }
1952 1.83 augustss
1953 1.83 augustss void
1954 1.168 augustss ohci_dump_itds(ohci_softc_t *sc, ohci_soft_itd_t *sitd)
1955 1.83 augustss {
1956 1.83 augustss for (; sitd; sitd = sitd->nextitd)
1957 1.168 augustss ohci_dump_itd(sc, sitd);
1958 1.83 augustss }
1959 1.83 augustss
1960 1.83 augustss void
1961 1.168 augustss ohci_dump_ed(ohci_softc_t *sc, ohci_soft_ed_t *sed)
1962 1.1 augustss {
1963 1.92 tv char sbuf[128], sbuf2[128];
1964 1.92 tv
1965 1.168 augustss bitmask_snprintf((u_int32_t)O32TOH(sed->ed.ed_flags),
1966 1.92 tv "\20\14OUT\15IN\16LOWSPEED\17SKIP\20ISO",
1967 1.92 tv sbuf, sizeof(sbuf));
1968 1.168 augustss bitmask_snprintf((u_int32_t)O32TOH(sed->ed.ed_headp),
1969 1.92 tv "\20\1HALT\2CARRY", sbuf2, sizeof(sbuf2));
1970 1.92 tv
1971 1.107 augustss printf("ED(%p) at 0x%08lx: addr=%d endpt=%d maxp=%d flags=%s\ntailp=0x%08lx "
1972 1.92 tv "headflags=%s headp=0x%08lx nexted=0x%08lx\n",
1973 1.120 augustss sed, (u_long)sed->physaddr,
1974 1.168 augustss OHCI_ED_GET_FA(O32TOH(sed->ed.ed_flags)),
1975 1.168 augustss OHCI_ED_GET_EN(O32TOH(sed->ed.ed_flags)),
1976 1.168 augustss OHCI_ED_GET_MAXP(O32TOH(sed->ed.ed_flags)), sbuf,
1977 1.168 augustss (u_long)O32TOH(sed->ed.ed_tailp), sbuf2,
1978 1.168 augustss (u_long)O32TOH(sed->ed.ed_headp),
1979 1.168 augustss (u_long)O32TOH(sed->ed.ed_nexted));
1980 1.1 augustss }
1981 1.1 augustss #endif
1982 1.1 augustss
1983 1.1 augustss usbd_status
1984 1.91 augustss ohci_open(usbd_pipe_handle pipe)
1985 1.1 augustss {
1986 1.1 augustss usbd_device_handle dev = pipe->device;
1987 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1988 1.1 augustss usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
1989 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1990 1.1 augustss u_int8_t addr = dev->address;
1991 1.60 augustss u_int8_t xfertype = ed->bmAttributes & UE_XFERTYPE;
1992 1.1 augustss ohci_soft_ed_t *sed;
1993 1.1 augustss ohci_soft_td_t *std;
1994 1.60 augustss ohci_soft_itd_t *sitd;
1995 1.60 augustss ohci_physaddr_t tdphys;
1996 1.60 augustss u_int32_t fmt;
1997 1.53 augustss usbd_status err;
1998 1.1 augustss int s;
1999 1.64 augustss int ival;
2000 1.1 augustss
2001 1.1 augustss DPRINTFN(1, ("ohci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
2002 1.1 augustss pipe, addr, ed->bEndpointAddress, sc->sc_addr));
2003 1.81 augustss
2004 1.116 augustss if (sc->sc_dying)
2005 1.116 augustss return (USBD_IOERROR);
2006 1.116 augustss
2007 1.90 thorpej std = NULL;
2008 1.90 thorpej sed = NULL;
2009 1.90 thorpej
2010 1.1 augustss if (addr == sc->sc_addr) {
2011 1.1 augustss switch (ed->bEndpointAddress) {
2012 1.1 augustss case USB_CONTROL_ENDPOINT:
2013 1.1 augustss pipe->methods = &ohci_root_ctrl_methods;
2014 1.1 augustss break;
2015 1.40 augustss case UE_DIR_IN | OHCI_INTR_ENDPT:
2016 1.1 augustss pipe->methods = &ohci_root_intr_methods;
2017 1.1 augustss break;
2018 1.1 augustss default:
2019 1.1 augustss return (USBD_INVAL);
2020 1.1 augustss }
2021 1.1 augustss } else {
2022 1.1 augustss sed = ohci_alloc_sed(sc);
2023 1.53 augustss if (sed == NULL)
2024 1.1 augustss goto bad0;
2025 1.1 augustss opipe->sed = sed;
2026 1.60 augustss if (xfertype == UE_ISOCHRONOUS) {
2027 1.60 augustss sitd = ohci_alloc_sitd(sc);
2028 1.127 augustss if (sitd == NULL)
2029 1.60 augustss goto bad1;
2030 1.60 augustss opipe->tail.itd = sitd;
2031 1.76 tsutsui tdphys = sitd->physaddr;
2032 1.60 augustss fmt = OHCI_ED_FORMAT_ISO;
2033 1.83 augustss if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)
2034 1.83 augustss fmt |= OHCI_ED_DIR_IN;
2035 1.83 augustss else
2036 1.83 augustss fmt |= OHCI_ED_DIR_OUT;
2037 1.60 augustss } else {
2038 1.60 augustss std = ohci_alloc_std(sc);
2039 1.127 augustss if (std == NULL)
2040 1.60 augustss goto bad1;
2041 1.60 augustss opipe->tail.td = std;
2042 1.76 tsutsui tdphys = std->physaddr;
2043 1.83 augustss fmt = OHCI_ED_FORMAT_GEN | OHCI_ED_DIR_TD;
2044 1.60 augustss }
2045 1.168 augustss sed->ed.ed_flags = HTOO32(
2046 1.120 augustss OHCI_ED_SET_FA(addr) |
2047 1.147 mycroft OHCI_ED_SET_EN(UE_GET_ADDR(ed->bEndpointAddress)) |
2048 1.109 augustss (dev->speed == USB_SPEED_LOW ? OHCI_ED_SPEED : 0) |
2049 1.109 augustss fmt |
2050 1.16 augustss OHCI_ED_SET_MAXP(UGETW(ed->wMaxPacketSize)));
2051 1.168 augustss sed->ed.ed_headp = sed->ed.ed_tailp = HTOO32(tdphys);
2052 1.1 augustss
2053 1.60 augustss switch (xfertype) {
2054 1.1 augustss case UE_CONTROL:
2055 1.1 augustss pipe->methods = &ohci_device_ctrl_methods;
2056 1.120 augustss err = usb_allocmem(&sc->sc_bus,
2057 1.120 augustss sizeof(usb_device_request_t),
2058 1.53 augustss 0, &opipe->u.ctl.reqdma);
2059 1.53 augustss if (err)
2060 1.1 augustss goto bad;
2061 1.1 augustss s = splusb();
2062 1.168 augustss ohci_add_ed(sc, sed, sc->sc_ctrl_head);
2063 1.1 augustss splx(s);
2064 1.1 augustss break;
2065 1.1 augustss case UE_INTERRUPT:
2066 1.1 augustss pipe->methods = &ohci_device_intr_methods;
2067 1.64 augustss ival = pipe->interval;
2068 1.64 augustss if (ival == USBD_DEFAULT_INTERVAL)
2069 1.64 augustss ival = ed->bInterval;
2070 1.64 augustss return (ohci_device_setintr(sc, opipe, ival));
2071 1.1 augustss case UE_ISOCHRONOUS:
2072 1.60 augustss pipe->methods = &ohci_device_isoc_methods;
2073 1.60 augustss return (ohci_setup_isoc(pipe));
2074 1.1 augustss case UE_BULK:
2075 1.3 augustss pipe->methods = &ohci_device_bulk_methods;
2076 1.3 augustss s = splusb();
2077 1.168 augustss ohci_add_ed(sc, sed, sc->sc_bulk_head);
2078 1.3 augustss splx(s);
2079 1.3 augustss break;
2080 1.1 augustss }
2081 1.1 augustss }
2082 1.1 augustss return (USBD_NORMAL_COMPLETION);
2083 1.1 augustss
2084 1.1 augustss bad:
2085 1.90 thorpej if (std != NULL)
2086 1.90 thorpej ohci_free_std(sc, std);
2087 1.1 augustss bad1:
2088 1.90 thorpej if (sed != NULL)
2089 1.90 thorpej ohci_free_sed(sc, sed);
2090 1.1 augustss bad0:
2091 1.1 augustss return (USBD_NOMEM);
2092 1.120 augustss
2093 1.1 augustss }
2094 1.1 augustss
2095 1.1 augustss /*
2096 1.34 augustss * Close a reqular pipe.
2097 1.34 augustss * Assumes that there are no pending transactions.
2098 1.34 augustss */
2099 1.34 augustss void
2100 1.91 augustss ohci_close_pipe(usbd_pipe_handle pipe, ohci_soft_ed_t *head)
2101 1.34 augustss {
2102 1.34 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2103 1.34 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2104 1.34 augustss ohci_soft_ed_t *sed = opipe->sed;
2105 1.34 augustss int s;
2106 1.34 augustss
2107 1.34 augustss s = splusb();
2108 1.34 augustss #ifdef DIAGNOSTIC
2109 1.168 augustss sed->ed.ed_flags |= HTOO32(OHCI_ED_SKIP);
2110 1.168 augustss if ((O32TOH(sed->ed.ed_tailp) & OHCI_HEADMASK) !=
2111 1.168 augustss (O32TOH(sed->ed.ed_headp) & OHCI_HEADMASK)) {
2112 1.34 augustss ohci_soft_td_t *std;
2113 1.168 augustss std = ohci_hash_find_td(sc, O32TOH(sed->ed.ed_headp));
2114 1.34 augustss printf("ohci_close_pipe: pipe not empty sed=%p hd=0x%x "
2115 1.34 augustss "tl=0x%x pipe=%p, std=%p\n", sed,
2116 1.168 augustss (int)O32TOH(sed->ed.ed_headp),
2117 1.168 augustss (int)O32TOH(sed->ed.ed_tailp),
2118 1.34 augustss pipe, std);
2119 1.107 augustss #ifdef USB_DEBUG
2120 1.107 augustss usbd_dump_pipe(&opipe->pipe);
2121 1.107 augustss #endif
2122 1.106 augustss #ifdef OHCI_DEBUG
2123 1.168 augustss ohci_dump_ed(sc, sed);
2124 1.106 augustss if (std)
2125 1.168 augustss ohci_dump_td(sc, std);
2126 1.106 augustss #endif
2127 1.34 augustss usb_delay_ms(&sc->sc_bus, 2);
2128 1.168 augustss if ((O32TOH(sed->ed.ed_tailp) & OHCI_HEADMASK) !=
2129 1.168 augustss (O32TOH(sed->ed.ed_headp) & OHCI_HEADMASK))
2130 1.34 augustss printf("ohci_close_pipe: pipe still not empty\n");
2131 1.34 augustss }
2132 1.34 augustss #endif
2133 1.34 augustss ohci_rem_ed(sed, head);
2134 1.133 toshii /* Make sure the host controller is not touching this ED */
2135 1.133 toshii usb_delay_ms(&sc->sc_bus, 1);
2136 1.34 augustss splx(s);
2137 1.34 augustss ohci_free_sed(sc, opipe->sed);
2138 1.34 augustss }
2139 1.34 augustss
2140 1.120 augustss /*
2141 1.34 augustss * Abort a device request.
2142 1.34 augustss * If this routine is called at splusb() it guarantees that the request
2143 1.34 augustss * will be removed from the hardware scheduling and that the callback
2144 1.34 augustss * for it will be called with USBD_CANCELLED status.
2145 1.34 augustss * It's impossible to guarantee that the requested transfer will not
2146 1.34 augustss * have happened since the hardware runs concurrently.
2147 1.34 augustss * If the transaction has already happened we rely on the ordinary
2148 1.34 augustss * interrupt processing to process it.
2149 1.34 augustss */
2150 1.34 augustss void
2151 1.91 augustss ohci_abort_xfer(usbd_xfer_handle xfer, usbd_status status)
2152 1.34 augustss {
2153 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2154 1.106 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
2155 1.106 augustss ohci_soft_ed_t *sed = opipe->sed;
2156 1.106 augustss ohci_soft_td_t *p, *n;
2157 1.106 augustss ohci_physaddr_t headp;
2158 1.106 augustss int s, hit;
2159 1.159 augustss int wake;
2160 1.34 augustss
2161 1.106 augustss DPRINTF(("ohci_abort_xfer: xfer=%p pipe=%p sed=%p\n", xfer, opipe,sed));
2162 1.34 augustss
2163 1.116 augustss if (sc->sc_dying) {
2164 1.116 augustss /* If we're dying, just do the software part. */
2165 1.116 augustss s = splusb();
2166 1.116 augustss xfer->status = status; /* make software ignore it */
2167 1.121 tsutsui usb_uncallout(xfer->timeout_handle, ohci_timeout, xfer);
2168 1.116 augustss usb_transfer_complete(xfer);
2169 1.116 augustss splx(s);
2170 1.170 christos return;
2171 1.116 augustss }
2172 1.116 augustss
2173 1.106 augustss if (xfer->device->bus->intr_context || !curproc)
2174 1.128 provos panic("ohci_abort_xfer: not in process context");
2175 1.34 augustss
2176 1.106 augustss /*
2177 1.159 augustss * If an abort is already in progress then just wait for it to
2178 1.159 augustss * complete and return.
2179 1.159 augustss */
2180 1.159 augustss if (xfer->hcflags & UXFER_ABORTING) {
2181 1.159 augustss DPRINTFN(2, ("ohci_abort_xfer: already aborting\n"));
2182 1.159 augustss #ifdef DIAGNOSTIC
2183 1.159 augustss if (status == USBD_TIMEOUT)
2184 1.159 augustss printf("0hci_abort_xfer: TIMEOUT while aborting\n");
2185 1.159 augustss #endif
2186 1.159 augustss /* Override the status which might be USBD_TIMEOUT. */
2187 1.159 augustss xfer->status = status;
2188 1.159 augustss DPRINTFN(2, ("ohci_abort_xfer: waiting for abort to finish\n"));
2189 1.159 augustss xfer->hcflags |= UXFER_ABORTWAIT;
2190 1.159 augustss while (xfer->hcflags & UXFER_ABORTING)
2191 1.159 augustss tsleep(&xfer->hcflags, PZERO, "ohciaw", 0);
2192 1.159 augustss return;
2193 1.159 augustss }
2194 1.159 augustss xfer->hcflags |= UXFER_ABORTING;
2195 1.159 augustss
2196 1.159 augustss /*
2197 1.106 augustss * Step 1: Make interrupt routine and hardware ignore xfer.
2198 1.106 augustss */
2199 1.106 augustss s = splusb();
2200 1.106 augustss xfer->status = status; /* make software ignore it */
2201 1.81 augustss usb_uncallout(xfer->timeout_handle, ohci_timeout, xfer);
2202 1.106 augustss splx(s);
2203 1.54 augustss DPRINTFN(1,("ohci_abort_xfer: stop ed=%p\n", sed));
2204 1.168 augustss sed->ed.ed_flags |= HTOO32(OHCI_ED_SKIP); /* force hardware skip */
2205 1.34 augustss
2206 1.120 augustss /*
2207 1.106 augustss * Step 2: Wait until we know hardware has finished any possible
2208 1.106 augustss * use of the xfer. Also make sure the soft interrupt routine
2209 1.106 augustss * has run.
2210 1.106 augustss */
2211 1.119 augustss usb_delay_ms(opipe->pipe.device->bus, 20); /* Hardware finishes in 1ms */
2212 1.119 augustss s = splusb();
2213 1.131 augustss #ifdef USB_USE_SOFTINTR
2214 1.119 augustss sc->sc_softwake = 1;
2215 1.131 augustss #endif /* USB_USE_SOFTINTR */
2216 1.119 augustss usb_schedsoftintr(&sc->sc_bus);
2217 1.131 augustss #ifdef USB_USE_SOFTINTR
2218 1.119 augustss tsleep(&sc->sc_softwake, PZERO, "ohciab", 0);
2219 1.131 augustss #endif /* USB_USE_SOFTINTR */
2220 1.119 augustss splx(s);
2221 1.119 augustss
2222 1.120 augustss /*
2223 1.106 augustss * Step 3: Remove any vestiges of the xfer from the hardware.
2224 1.106 augustss * The complication here is that the hardware may have executed
2225 1.106 augustss * beyond the xfer we're trying to abort. So as we're scanning
2226 1.106 augustss * the TDs of this xfer we check if the hardware points to
2227 1.106 augustss * any of them.
2228 1.106 augustss */
2229 1.106 augustss s = splusb(); /* XXX why? */
2230 1.53 augustss p = xfer->hcpriv;
2231 1.34 augustss #ifdef DIAGNOSTIC
2232 1.55 augustss if (p == NULL) {
2233 1.159 augustss xfer->hcflags &= ~UXFER_ABORTING; /* XXX */
2234 1.102 augustss splx(s);
2235 1.106 augustss printf("ohci_abort_xfer: hcpriv is NULL\n");
2236 1.38 augustss return;
2237 1.38 augustss }
2238 1.34 augustss #endif
2239 1.106 augustss #ifdef OHCI_DEBUG
2240 1.106 augustss if (ohcidebug > 1) {
2241 1.106 augustss DPRINTF(("ohci_abort_xfer: sed=\n"));
2242 1.168 augustss ohci_dump_ed(sc, sed);
2243 1.168 augustss ohci_dump_tds(sc, p);
2244 1.106 augustss }
2245 1.106 augustss #endif
2246 1.168 augustss headp = O32TOH(sed->ed.ed_headp) & OHCI_HEADMASK;
2247 1.106 augustss hit = 0;
2248 1.53 augustss for (; p->xfer == xfer; p = n) {
2249 1.106 augustss hit |= headp == p->physaddr;
2250 1.38 augustss n = p->nexttd;
2251 1.38 augustss ohci_free_std(sc, p);
2252 1.34 augustss }
2253 1.106 augustss /* Zap headp register if hardware pointed inside the xfer. */
2254 1.106 augustss if (hit) {
2255 1.150 mycroft DPRINTFN(1,("ohci_abort_xfer: set hd=0x%08x, tl=0x%08x\n",
2256 1.168 augustss (int)p->physaddr, (int)O32TOH(sed->ed.ed_tailp)));
2257 1.168 augustss sed->ed.ed_headp = HTOO32(p->physaddr); /* unlink TDs */
2258 1.106 augustss } else {
2259 1.106 augustss DPRINTFN(1,("ohci_abort_xfer: no hit\n"));
2260 1.106 augustss }
2261 1.34 augustss
2262 1.106 augustss /*
2263 1.106 augustss * Step 4: Turn on hardware again.
2264 1.106 augustss */
2265 1.168 augustss sed->ed.ed_flags &= HTOO32(~OHCI_ED_SKIP); /* remove hardware skip */
2266 1.38 augustss
2267 1.106 augustss /*
2268 1.106 augustss * Step 5: Execute callback.
2269 1.106 augustss */
2270 1.159 augustss wake = xfer->hcflags & UXFER_ABORTWAIT;
2271 1.159 augustss xfer->hcflags &= ~(UXFER_ABORTING | UXFER_ABORTWAIT);
2272 1.53 augustss usb_transfer_complete(xfer);
2273 1.159 augustss if (wake)
2274 1.159 augustss wakeup(&xfer->hcflags);
2275 1.38 augustss
2276 1.34 augustss splx(s);
2277 1.34 augustss }
2278 1.34 augustss
2279 1.34 augustss /*
2280 1.1 augustss * Data structures and routines to emulate the root hub.
2281 1.1 augustss */
2282 1.82 augustss Static usb_device_descriptor_t ohci_devd = {
2283 1.1 augustss USB_DEVICE_DESCRIPTOR_SIZE,
2284 1.1 augustss UDESC_DEVICE, /* type */
2285 1.1 augustss {0x00, 0x01}, /* USB version */
2286 1.74 augustss UDCLASS_HUB, /* class */
2287 1.74 augustss UDSUBCLASS_HUB, /* subclass */
2288 1.109 augustss UDPROTO_FSHUB,
2289 1.1 augustss 64, /* max packet */
2290 1.1 augustss {0},{0},{0x00,0x01}, /* device id */
2291 1.1 augustss 1,2,0, /* string indicies */
2292 1.1 augustss 1 /* # of configurations */
2293 1.1 augustss };
2294 1.1 augustss
2295 1.82 augustss Static usb_config_descriptor_t ohci_confd = {
2296 1.1 augustss USB_CONFIG_DESCRIPTOR_SIZE,
2297 1.1 augustss UDESC_CONFIG,
2298 1.1 augustss {USB_CONFIG_DESCRIPTOR_SIZE +
2299 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE +
2300 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE},
2301 1.1 augustss 1,
2302 1.1 augustss 1,
2303 1.1 augustss 0,
2304 1.1 augustss UC_SELF_POWERED,
2305 1.1 augustss 0 /* max power */
2306 1.1 augustss };
2307 1.1 augustss
2308 1.82 augustss Static usb_interface_descriptor_t ohci_ifcd = {
2309 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE,
2310 1.1 augustss UDESC_INTERFACE,
2311 1.1 augustss 0,
2312 1.1 augustss 0,
2313 1.1 augustss 1,
2314 1.74 augustss UICLASS_HUB,
2315 1.74 augustss UISUBCLASS_HUB,
2316 1.109 augustss UIPROTO_FSHUB,
2317 1.1 augustss 0
2318 1.1 augustss };
2319 1.1 augustss
2320 1.82 augustss Static usb_endpoint_descriptor_t ohci_endpd = {
2321 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE,
2322 1.1 augustss UDESC_ENDPOINT,
2323 1.40 augustss UE_DIR_IN | OHCI_INTR_ENDPT,
2324 1.1 augustss UE_INTERRUPT,
2325 1.1 augustss {8, 0}, /* max packet */
2326 1.1 augustss 255
2327 1.1 augustss };
2328 1.1 augustss
2329 1.82 augustss Static usb_hub_descriptor_t ohci_hubd = {
2330 1.1 augustss USB_HUB_DESCRIPTOR_SIZE,
2331 1.1 augustss UDESC_HUB,
2332 1.1 augustss 0,
2333 1.1 augustss {0,0},
2334 1.1 augustss 0,
2335 1.1 augustss 0,
2336 1.1 augustss {0},
2337 1.1 augustss };
2338 1.1 augustss
2339 1.82 augustss Static int
2340 1.120 augustss ohci_str(usb_string_descriptor_t *p, int l, const char *s)
2341 1.1 augustss {
2342 1.1 augustss int i;
2343 1.1 augustss
2344 1.1 augustss if (l == 0)
2345 1.1 augustss return (0);
2346 1.1 augustss p->bLength = 2 * strlen(s) + 2;
2347 1.1 augustss if (l == 1)
2348 1.1 augustss return (1);
2349 1.1 augustss p->bDescriptorType = UDESC_STRING;
2350 1.1 augustss l -= 2;
2351 1.1 augustss for (i = 0; s[i] && l > 1; i++, l -= 2)
2352 1.1 augustss USETW2(p->bString[i], 0, s[i]);
2353 1.1 augustss return (2*i+2);
2354 1.1 augustss }
2355 1.1 augustss
2356 1.1 augustss /*
2357 1.1 augustss * Simulate a hardware hub by handling all the necessary requests.
2358 1.1 augustss */
2359 1.82 augustss Static usbd_status
2360 1.91 augustss ohci_root_ctrl_transfer(usbd_xfer_handle xfer)
2361 1.1 augustss {
2362 1.53 augustss usbd_status err;
2363 1.17 augustss
2364 1.46 augustss /* Insert last in queue. */
2365 1.53 augustss err = usb_insert_transfer(xfer);
2366 1.53 augustss if (err)
2367 1.53 augustss return (err);
2368 1.46 augustss
2369 1.46 augustss /* Pipe isn't running, start first */
2370 1.53 augustss return (ohci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2371 1.17 augustss }
2372 1.17 augustss
2373 1.82 augustss Static usbd_status
2374 1.91 augustss ohci_root_ctrl_start(usbd_xfer_handle xfer)
2375 1.17 augustss {
2376 1.53 augustss ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
2377 1.1 augustss usb_device_request_t *req;
2378 1.52 augustss void *buf = NULL;
2379 1.1 augustss int port, i;
2380 1.46 augustss int s, len, value, index, l, totlen = 0;
2381 1.1 augustss usb_port_status_t ps;
2382 1.1 augustss usb_hub_descriptor_t hubd;
2383 1.53 augustss usbd_status err;
2384 1.1 augustss u_int32_t v;
2385 1.1 augustss
2386 1.83 augustss if (sc->sc_dying)
2387 1.83 augustss return (USBD_IOERROR);
2388 1.83 augustss
2389 1.42 augustss #ifdef DIAGNOSTIC
2390 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST))
2391 1.1 augustss /* XXX panic */
2392 1.1 augustss return (USBD_INVAL);
2393 1.42 augustss #endif
2394 1.53 augustss req = &xfer->request;
2395 1.1 augustss
2396 1.120 augustss DPRINTFN(4,("ohci_root_ctrl_control type=0x%02x request=%02x\n",
2397 1.1 augustss req->bmRequestType, req->bRequest));
2398 1.1 augustss
2399 1.1 augustss len = UGETW(req->wLength);
2400 1.1 augustss value = UGETW(req->wValue);
2401 1.1 augustss index = UGETW(req->wIndex);
2402 1.43 augustss
2403 1.43 augustss if (len != 0)
2404 1.123 augustss buf = KERNADDR(&xfer->dmabuf, 0);
2405 1.43 augustss
2406 1.1 augustss #define C(x,y) ((x) | ((y) << 8))
2407 1.1 augustss switch(C(req->bRequest, req->bmRequestType)) {
2408 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
2409 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
2410 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
2411 1.120 augustss /*
2412 1.15 augustss * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
2413 1.1 augustss * for the integrated root hub.
2414 1.1 augustss */
2415 1.1 augustss break;
2416 1.1 augustss case C(UR_GET_CONFIG, UT_READ_DEVICE):
2417 1.1 augustss if (len > 0) {
2418 1.1 augustss *(u_int8_t *)buf = sc->sc_conf;
2419 1.1 augustss totlen = 1;
2420 1.1 augustss }
2421 1.1 augustss break;
2422 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
2423 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_control wValue=0x%04x\n", value));
2424 1.1 augustss switch(value >> 8) {
2425 1.1 augustss case UDESC_DEVICE:
2426 1.1 augustss if ((value & 0xff) != 0) {
2427 1.53 augustss err = USBD_IOERROR;
2428 1.1 augustss goto ret;
2429 1.1 augustss }
2430 1.1 augustss totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
2431 1.29 augustss USETW(ohci_devd.idVendor, sc->sc_id_vendor);
2432 1.1 augustss memcpy(buf, &ohci_devd, l);
2433 1.1 augustss break;
2434 1.1 augustss case UDESC_CONFIG:
2435 1.1 augustss if ((value & 0xff) != 0) {
2436 1.53 augustss err = USBD_IOERROR;
2437 1.1 augustss goto ret;
2438 1.1 augustss }
2439 1.1 augustss totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
2440 1.1 augustss memcpy(buf, &ohci_confd, l);
2441 1.1 augustss buf = (char *)buf + l;
2442 1.1 augustss len -= l;
2443 1.1 augustss l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
2444 1.1 augustss totlen += l;
2445 1.1 augustss memcpy(buf, &ohci_ifcd, l);
2446 1.1 augustss buf = (char *)buf + l;
2447 1.1 augustss len -= l;
2448 1.1 augustss l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
2449 1.1 augustss totlen += l;
2450 1.1 augustss memcpy(buf, &ohci_endpd, l);
2451 1.1 augustss break;
2452 1.1 augustss case UDESC_STRING:
2453 1.1 augustss if (len == 0)
2454 1.1 augustss break;
2455 1.1 augustss *(u_int8_t *)buf = 0;
2456 1.1 augustss totlen = 1;
2457 1.1 augustss switch (value & 0xff) {
2458 1.152 augustss case 0: /* Language table */
2459 1.152 augustss totlen = ohci_str(buf, len, "\001");
2460 1.152 augustss break;
2461 1.1 augustss case 1: /* Vendor */
2462 1.1 augustss totlen = ohci_str(buf, len, sc->sc_vendor);
2463 1.1 augustss break;
2464 1.1 augustss case 2: /* Product */
2465 1.1 augustss totlen = ohci_str(buf, len, "OHCI root hub");
2466 1.1 augustss break;
2467 1.1 augustss }
2468 1.1 augustss break;
2469 1.1 augustss default:
2470 1.53 augustss err = USBD_IOERROR;
2471 1.1 augustss goto ret;
2472 1.1 augustss }
2473 1.1 augustss break;
2474 1.1 augustss case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
2475 1.1 augustss if (len > 0) {
2476 1.1 augustss *(u_int8_t *)buf = 0;
2477 1.1 augustss totlen = 1;
2478 1.1 augustss }
2479 1.1 augustss break;
2480 1.1 augustss case C(UR_GET_STATUS, UT_READ_DEVICE):
2481 1.1 augustss if (len > 1) {
2482 1.1 augustss USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
2483 1.1 augustss totlen = 2;
2484 1.1 augustss }
2485 1.1 augustss break;
2486 1.1 augustss case C(UR_GET_STATUS, UT_READ_INTERFACE):
2487 1.1 augustss case C(UR_GET_STATUS, UT_READ_ENDPOINT):
2488 1.1 augustss if (len > 1) {
2489 1.1 augustss USETW(((usb_status_t *)buf)->wStatus, 0);
2490 1.1 augustss totlen = 2;
2491 1.1 augustss }
2492 1.1 augustss break;
2493 1.1 augustss case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
2494 1.1 augustss if (value >= USB_MAX_DEVICES) {
2495 1.53 augustss err = USBD_IOERROR;
2496 1.1 augustss goto ret;
2497 1.1 augustss }
2498 1.1 augustss sc->sc_addr = value;
2499 1.1 augustss break;
2500 1.1 augustss case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
2501 1.1 augustss if (value != 0 && value != 1) {
2502 1.53 augustss err = USBD_IOERROR;
2503 1.1 augustss goto ret;
2504 1.1 augustss }
2505 1.1 augustss sc->sc_conf = value;
2506 1.1 augustss break;
2507 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
2508 1.1 augustss break;
2509 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
2510 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
2511 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
2512 1.53 augustss err = USBD_IOERROR;
2513 1.1 augustss goto ret;
2514 1.1 augustss case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
2515 1.1 augustss break;
2516 1.1 augustss case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
2517 1.1 augustss break;
2518 1.1 augustss /* Hub requests */
2519 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
2520 1.1 augustss break;
2521 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
2522 1.14 augustss DPRINTFN(8, ("ohci_root_ctrl_control: UR_CLEAR_PORT_FEATURE "
2523 1.14 augustss "port=%d feature=%d\n",
2524 1.1 augustss index, value));
2525 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2526 1.53 augustss err = USBD_IOERROR;
2527 1.1 augustss goto ret;
2528 1.1 augustss }
2529 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
2530 1.1 augustss switch(value) {
2531 1.1 augustss case UHF_PORT_ENABLE:
2532 1.1 augustss OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS);
2533 1.1 augustss break;
2534 1.1 augustss case UHF_PORT_SUSPEND:
2535 1.1 augustss OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR);
2536 1.1 augustss break;
2537 1.1 augustss case UHF_PORT_POWER:
2538 1.86 augustss /* Yes, writing to the LOW_SPEED bit clears power. */
2539 1.1 augustss OWRITE4(sc, port, UPS_LOW_SPEED);
2540 1.1 augustss break;
2541 1.1 augustss case UHF_C_PORT_CONNECTION:
2542 1.1 augustss OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16);
2543 1.1 augustss break;
2544 1.1 augustss case UHF_C_PORT_ENABLE:
2545 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16);
2546 1.1 augustss break;
2547 1.1 augustss case UHF_C_PORT_SUSPEND:
2548 1.1 augustss OWRITE4(sc, port, UPS_C_SUSPEND << 16);
2549 1.1 augustss break;
2550 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
2551 1.1 augustss OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16);
2552 1.1 augustss break;
2553 1.1 augustss case UHF_C_PORT_RESET:
2554 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_RESET << 16);
2555 1.1 augustss break;
2556 1.1 augustss default:
2557 1.53 augustss err = USBD_IOERROR;
2558 1.1 augustss goto ret;
2559 1.1 augustss }
2560 1.1 augustss switch(value) {
2561 1.1 augustss case UHF_C_PORT_CONNECTION:
2562 1.1 augustss case UHF_C_PORT_ENABLE:
2563 1.1 augustss case UHF_C_PORT_SUSPEND:
2564 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
2565 1.1 augustss case UHF_C_PORT_RESET:
2566 1.1 augustss /* Enable RHSC interrupt if condition is cleared. */
2567 1.1 augustss if ((OREAD4(sc, port) >> 16) == 0)
2568 1.157 mycroft ohci_rhsc_enable(sc);
2569 1.1 augustss break;
2570 1.1 augustss default:
2571 1.1 augustss break;
2572 1.1 augustss }
2573 1.1 augustss break;
2574 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
2575 1.146 toshii if ((value & 0xff) != 0) {
2576 1.53 augustss err = USBD_IOERROR;
2577 1.1 augustss goto ret;
2578 1.1 augustss }
2579 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
2580 1.1 augustss hubd = ohci_hubd;
2581 1.1 augustss hubd.bNbrPorts = sc->sc_noport;
2582 1.15 augustss USETW(hubd.wHubCharacteristics,
2583 1.120 augustss (v & OHCI_NPS ? UHD_PWR_NO_SWITCH :
2584 1.1 augustss v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL)
2585 1.1 augustss /* XXX overcurrent */
2586 1.1 augustss );
2587 1.1 augustss hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v);
2588 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
2589 1.120 augustss for (i = 0, l = sc->sc_noport; l > 0; i++, l -= 8, v >>= 8)
2590 1.15 augustss hubd.DeviceRemovable[i++] = (u_int8_t)v;
2591 1.15 augustss hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i;
2592 1.1 augustss l = min(len, hubd.bDescLength);
2593 1.1 augustss totlen = l;
2594 1.1 augustss memcpy(buf, &hubd, l);
2595 1.1 augustss break;
2596 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
2597 1.1 augustss if (len != 4) {
2598 1.53 augustss err = USBD_IOERROR;
2599 1.1 augustss goto ret;
2600 1.1 augustss }
2601 1.1 augustss memset(buf, 0, len); /* ? XXX */
2602 1.1 augustss totlen = len;
2603 1.1 augustss break;
2604 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
2605 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: get port status i=%d\n",
2606 1.1 augustss index));
2607 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2608 1.53 augustss err = USBD_IOERROR;
2609 1.1 augustss goto ret;
2610 1.1 augustss }
2611 1.1 augustss if (len != 4) {
2612 1.53 augustss err = USBD_IOERROR;
2613 1.1 augustss goto ret;
2614 1.1 augustss }
2615 1.1 augustss v = OREAD4(sc, OHCI_RH_PORT_STATUS(index));
2616 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: port status=0x%04x\n",
2617 1.1 augustss v));
2618 1.1 augustss USETW(ps.wPortStatus, v);
2619 1.1 augustss USETW(ps.wPortChange, v >> 16);
2620 1.1 augustss l = min(len, sizeof ps);
2621 1.1 augustss memcpy(buf, &ps, l);
2622 1.1 augustss totlen = l;
2623 1.1 augustss break;
2624 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
2625 1.53 augustss err = USBD_IOERROR;
2626 1.1 augustss goto ret;
2627 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
2628 1.1 augustss break;
2629 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
2630 1.1 augustss if (index < 1 || index > sc->sc_noport) {
2631 1.53 augustss err = USBD_IOERROR;
2632 1.1 augustss goto ret;
2633 1.1 augustss }
2634 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
2635 1.1 augustss switch(value) {
2636 1.1 augustss case UHF_PORT_ENABLE:
2637 1.1 augustss OWRITE4(sc, port, UPS_PORT_ENABLED);
2638 1.1 augustss break;
2639 1.1 augustss case UHF_PORT_SUSPEND:
2640 1.1 augustss OWRITE4(sc, port, UPS_SUSPEND);
2641 1.1 augustss break;
2642 1.1 augustss case UHF_PORT_RESET:
2643 1.14 augustss DPRINTFN(5,("ohci_root_ctrl_transfer: reset port %d\n",
2644 1.14 augustss index));
2645 1.1 augustss OWRITE4(sc, port, UPS_RESET);
2646 1.110 augustss for (i = 0; i < 5; i++) {
2647 1.110 augustss usb_delay_ms(&sc->sc_bus,
2648 1.110 augustss USB_PORT_ROOT_RESET_DELAY);
2649 1.116 augustss if (sc->sc_dying) {
2650 1.116 augustss err = USBD_IOERROR;
2651 1.116 augustss goto ret;
2652 1.116 augustss }
2653 1.1 augustss if ((OREAD4(sc, port) & UPS_RESET) == 0)
2654 1.1 augustss break;
2655 1.1 augustss }
2656 1.1 augustss DPRINTFN(8,("ohci port %d reset, status = 0x%04x\n",
2657 1.1 augustss index, OREAD4(sc, port)));
2658 1.1 augustss break;
2659 1.1 augustss case UHF_PORT_POWER:
2660 1.14 augustss DPRINTFN(2,("ohci_root_ctrl_transfer: set port power "
2661 1.14 augustss "%d\n", index));
2662 1.1 augustss OWRITE4(sc, port, UPS_PORT_POWER);
2663 1.1 augustss break;
2664 1.1 augustss default:
2665 1.53 augustss err = USBD_IOERROR;
2666 1.1 augustss goto ret;
2667 1.1 augustss }
2668 1.1 augustss break;
2669 1.1 augustss default:
2670 1.53 augustss err = USBD_IOERROR;
2671 1.1 augustss goto ret;
2672 1.1 augustss }
2673 1.53 augustss xfer->actlen = totlen;
2674 1.53 augustss err = USBD_NORMAL_COMPLETION;
2675 1.1 augustss ret:
2676 1.53 augustss xfer->status = err;
2677 1.46 augustss s = splusb();
2678 1.53 augustss usb_transfer_complete(xfer);
2679 1.46 augustss splx(s);
2680 1.1 augustss return (USBD_IN_PROGRESS);
2681 1.1 augustss }
2682 1.1 augustss
2683 1.1 augustss /* Abort a root control request. */
2684 1.82 augustss Static void
2685 1.91 augustss ohci_root_ctrl_abort(usbd_xfer_handle xfer)
2686 1.1 augustss {
2687 1.9 augustss /* Nothing to do, all transfers are synchronous. */
2688 1.1 augustss }
2689 1.1 augustss
2690 1.1 augustss /* Close the root pipe. */
2691 1.82 augustss Static void
2692 1.91 augustss ohci_root_ctrl_close(usbd_pipe_handle pipe)
2693 1.1 augustss {
2694 1.1 augustss DPRINTF(("ohci_root_ctrl_close\n"));
2695 1.34 augustss /* Nothing to do. */
2696 1.1 augustss }
2697 1.1 augustss
2698 1.82 augustss Static usbd_status
2699 1.91 augustss ohci_root_intr_transfer(usbd_xfer_handle xfer)
2700 1.1 augustss {
2701 1.53 augustss usbd_status err;
2702 1.17 augustss
2703 1.46 augustss /* Insert last in queue. */
2704 1.53 augustss err = usb_insert_transfer(xfer);
2705 1.53 augustss if (err)
2706 1.53 augustss return (err);
2707 1.46 augustss
2708 1.46 augustss /* Pipe isn't running, start first */
2709 1.53 augustss return (ohci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2710 1.17 augustss }
2711 1.17 augustss
2712 1.82 augustss Static usbd_status
2713 1.91 augustss ohci_root_intr_start(usbd_xfer_handle xfer)
2714 1.17 augustss {
2715 1.53 augustss usbd_pipe_handle pipe = xfer->pipe;
2716 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2717 1.1 augustss
2718 1.83 augustss if (sc->sc_dying)
2719 1.83 augustss return (USBD_IOERROR);
2720 1.83 augustss
2721 1.53 augustss sc->sc_intrxfer = xfer;
2722 1.1 augustss
2723 1.1 augustss return (USBD_IN_PROGRESS);
2724 1.1 augustss }
2725 1.1 augustss
2726 1.3 augustss /* Abort a root interrupt request. */
2727 1.82 augustss Static void
2728 1.91 augustss ohci_root_intr_abort(usbd_xfer_handle xfer)
2729 1.1 augustss {
2730 1.53 augustss int s;
2731 1.53 augustss
2732 1.53 augustss if (xfer->pipe->intrxfer == xfer) {
2733 1.51 augustss DPRINTF(("ohci_root_intr_abort: remove\n"));
2734 1.53 augustss xfer->pipe->intrxfer = NULL;
2735 1.51 augustss }
2736 1.53 augustss xfer->status = USBD_CANCELLED;
2737 1.53 augustss s = splusb();
2738 1.53 augustss usb_transfer_complete(xfer);
2739 1.53 augustss splx(s);
2740 1.1 augustss }
2741 1.1 augustss
2742 1.1 augustss /* Close the root pipe. */
2743 1.82 augustss Static void
2744 1.91 augustss ohci_root_intr_close(usbd_pipe_handle pipe)
2745 1.1 augustss {
2746 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2747 1.120 augustss
2748 1.1 augustss DPRINTF(("ohci_root_intr_close\n"));
2749 1.34 augustss
2750 1.53 augustss sc->sc_intrxfer = NULL;
2751 1.1 augustss }
2752 1.1 augustss
2753 1.1 augustss /************************/
2754 1.1 augustss
2755 1.82 augustss Static usbd_status
2756 1.91 augustss ohci_device_ctrl_transfer(usbd_xfer_handle xfer)
2757 1.1 augustss {
2758 1.53 augustss usbd_status err;
2759 1.17 augustss
2760 1.46 augustss /* Insert last in queue. */
2761 1.53 augustss err = usb_insert_transfer(xfer);
2762 1.53 augustss if (err)
2763 1.53 augustss return (err);
2764 1.46 augustss
2765 1.46 augustss /* Pipe isn't running, start first */
2766 1.53 augustss return (ohci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2767 1.17 augustss }
2768 1.17 augustss
2769 1.82 augustss Static usbd_status
2770 1.91 augustss ohci_device_ctrl_start(usbd_xfer_handle xfer)
2771 1.17 augustss {
2772 1.53 augustss ohci_softc_t *sc = (ohci_softc_t *)xfer->pipe->device->bus;
2773 1.53 augustss usbd_status err;
2774 1.1 augustss
2775 1.83 augustss if (sc->sc_dying)
2776 1.83 augustss return (USBD_IOERROR);
2777 1.83 augustss
2778 1.42 augustss #ifdef DIAGNOSTIC
2779 1.53 augustss if (!(xfer->rqflags & URQ_REQUEST)) {
2780 1.1 augustss /* XXX panic */
2781 1.1 augustss printf("ohci_device_ctrl_transfer: not a request\n");
2782 1.1 augustss return (USBD_INVAL);
2783 1.1 augustss }
2784 1.42 augustss #endif
2785 1.1 augustss
2786 1.53 augustss err = ohci_device_request(xfer);
2787 1.53 augustss if (err)
2788 1.53 augustss return (err);
2789 1.1 augustss
2790 1.6 augustss if (sc->sc_bus.use_polling)
2791 1.53 augustss ohci_waitintr(sc, xfer);
2792 1.1 augustss return (USBD_IN_PROGRESS);
2793 1.1 augustss }
2794 1.1 augustss
2795 1.1 augustss /* Abort a device control request. */
2796 1.82 augustss Static void
2797 1.91 augustss ohci_device_ctrl_abort(usbd_xfer_handle xfer)
2798 1.1 augustss {
2799 1.53 augustss DPRINTF(("ohci_device_ctrl_abort: xfer=%p\n", xfer));
2800 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2801 1.1 augustss }
2802 1.1 augustss
2803 1.1 augustss /* Close a device control pipe. */
2804 1.82 augustss Static void
2805 1.91 augustss ohci_device_ctrl_close(usbd_pipe_handle pipe)
2806 1.1 augustss {
2807 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2808 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2809 1.1 augustss
2810 1.34 augustss DPRINTF(("ohci_device_ctrl_close: pipe=%p\n", pipe));
2811 1.34 augustss ohci_close_pipe(pipe, sc->sc_ctrl_head);
2812 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2813 1.3 augustss }
2814 1.3 augustss
2815 1.3 augustss /************************/
2816 1.37 augustss
2817 1.82 augustss Static void
2818 1.91 augustss ohci_device_clear_toggle(usbd_pipe_handle pipe)
2819 1.37 augustss {
2820 1.37 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2821 1.168 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2822 1.37 augustss
2823 1.168 augustss opipe->sed->ed.ed_headp &= HTOO32(~OHCI_TOGGLECARRY);
2824 1.37 augustss }
2825 1.37 augustss
2826 1.82 augustss Static void
2827 1.91 augustss ohci_noop(usbd_pipe_handle pipe)
2828 1.37 augustss {
2829 1.37 augustss }
2830 1.3 augustss
2831 1.82 augustss Static usbd_status
2832 1.91 augustss ohci_device_bulk_transfer(usbd_xfer_handle xfer)
2833 1.3 augustss {
2834 1.53 augustss usbd_status err;
2835 1.17 augustss
2836 1.46 augustss /* Insert last in queue. */
2837 1.53 augustss err = usb_insert_transfer(xfer);
2838 1.53 augustss if (err)
2839 1.53 augustss return (err);
2840 1.46 augustss
2841 1.46 augustss /* Pipe isn't running, start first */
2842 1.53 augustss return (ohci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2843 1.17 augustss }
2844 1.17 augustss
2845 1.82 augustss Static usbd_status
2846 1.91 augustss ohci_device_bulk_start(usbd_xfer_handle xfer)
2847 1.17 augustss {
2848 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2849 1.3 augustss usbd_device_handle dev = opipe->pipe.device;
2850 1.3 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2851 1.3 augustss int addr = dev->address;
2852 1.48 augustss ohci_soft_td_t *data, *tail, *tdp;
2853 1.3 augustss ohci_soft_ed_t *sed;
2854 1.40 augustss int s, len, isread, endpt;
2855 1.53 augustss usbd_status err;
2856 1.3 augustss
2857 1.83 augustss if (sc->sc_dying)
2858 1.83 augustss return (USBD_IOERROR);
2859 1.83 augustss
2860 1.34 augustss #ifdef DIAGNOSTIC
2861 1.53 augustss if (xfer->rqflags & URQ_REQUEST) {
2862 1.3 augustss /* XXX panic */
2863 1.34 augustss printf("ohci_device_bulk_start: a request\n");
2864 1.3 augustss return (USBD_INVAL);
2865 1.3 augustss }
2866 1.34 augustss #endif
2867 1.3 augustss
2868 1.53 augustss len = xfer->length;
2869 1.53 augustss endpt = xfer->pipe->endpoint->edesc->bEndpointAddress;
2870 1.40 augustss isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2871 1.3 augustss sed = opipe->sed;
2872 1.3 augustss
2873 1.53 augustss DPRINTFN(4,("ohci_device_bulk_start: xfer=%p len=%d isread=%d "
2874 1.53 augustss "flags=%d endpt=%d\n", xfer, len, isread, xfer->flags,
2875 1.40 augustss endpt));
2876 1.34 augustss
2877 1.32 augustss opipe->u.bulk.isread = isread;
2878 1.3 augustss opipe->u.bulk.length = len;
2879 1.3 augustss
2880 1.3 augustss /* Update device address */
2881 1.168 augustss sed->ed.ed_flags = HTOO32(
2882 1.168 augustss (O32TOH(sed->ed.ed_flags) & ~OHCI_ED_ADDRMASK) |
2883 1.16 augustss OHCI_ED_SET_FA(addr));
2884 1.3 augustss
2885 1.48 augustss /* Allocate a chain of new TDs (including a new tail). */
2886 1.60 augustss data = opipe->tail.td;
2887 1.77 augustss err = ohci_alloc_std_chain(opipe, sc, len, isread, xfer,
2888 1.77 augustss data, &tail);
2889 1.77 augustss /* We want interrupt at the end of the transfer. */
2890 1.168 augustss tail->td.td_flags &= HTOO32(~OHCI_TD_INTR_MASK);
2891 1.168 augustss tail->td.td_flags |= HTOO32(OHCI_TD_SET_DI(1));
2892 1.77 augustss tail->flags |= OHCI_CALL_DONE;
2893 1.77 augustss tail = tail->nexttd; /* point at sentinel */
2894 1.53 augustss if (err)
2895 1.53 augustss return (err);
2896 1.48 augustss
2897 1.53 augustss tail->xfer = NULL;
2898 1.53 augustss xfer->hcpriv = data;
2899 1.3 augustss
2900 1.34 augustss DPRINTFN(4,("ohci_device_bulk_start: ed_flags=0x%08x td_flags=0x%08x "
2901 1.34 augustss "td_cbp=0x%08x td_be=0x%08x\n",
2902 1.168 augustss (int)O32TOH(sed->ed.ed_flags),
2903 1.168 augustss (int)O32TOH(data->td.td_flags),
2904 1.168 augustss (int)O32TOH(data->td.td_cbp),
2905 1.168 augustss (int)O32TOH(data->td.td_be)));
2906 1.34 augustss
2907 1.52 augustss #ifdef OHCI_DEBUG
2908 1.75 augustss if (ohcidebug > 5) {
2909 1.168 augustss ohci_dump_ed(sc, sed);
2910 1.168 augustss ohci_dump_tds(sc, data);
2911 1.34 augustss }
2912 1.34 augustss #endif
2913 1.34 augustss
2914 1.3 augustss /* Insert ED in schedule */
2915 1.3 augustss s = splusb();
2916 1.48 augustss for (tdp = data; tdp != tail; tdp = tdp->nexttd) {
2917 1.53 augustss tdp->xfer = xfer;
2918 1.48 augustss }
2919 1.168 augustss sed->ed.ed_tailp = HTOO32(tail->physaddr);
2920 1.60 augustss opipe->tail.td = tail;
2921 1.168 augustss sed->ed.ed_flags &= HTOO32(~OHCI_ED_SKIP);
2922 1.3 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF);
2923 1.53 augustss if (xfer->timeout && !sc->sc_bus.use_polling) {
2924 1.139 tsutsui usb_callout(xfer->timeout_handle, mstohz(xfer->timeout),
2925 1.80 augustss ohci_timeout, xfer);
2926 1.15 augustss }
2927 1.34 augustss
2928 1.52 augustss #if 0
2929 1.52 augustss /* This goes wrong if we are too slow. */
2930 1.75 augustss if (ohcidebug > 10) {
2931 1.75 augustss delay(10000);
2932 1.41 augustss DPRINTF(("ohci_device_intr_transfer: status=%x\n",
2933 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
2934 1.168 augustss ohci_dump_ed(sc, sed);
2935 1.168 augustss ohci_dump_tds(sc, data);
2936 1.34 augustss }
2937 1.34 augustss #endif
2938 1.34 augustss
2939 1.3 augustss splx(s);
2940 1.3 augustss
2941 1.3 augustss return (USBD_IN_PROGRESS);
2942 1.3 augustss }
2943 1.3 augustss
2944 1.82 augustss Static void
2945 1.91 augustss ohci_device_bulk_abort(usbd_xfer_handle xfer)
2946 1.3 augustss {
2947 1.53 augustss DPRINTF(("ohci_device_bulk_abort: xfer=%p\n", xfer));
2948 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
2949 1.3 augustss }
2950 1.3 augustss
2951 1.120 augustss /*
2952 1.34 augustss * Close a device bulk pipe.
2953 1.34 augustss */
2954 1.82 augustss Static void
2955 1.91 augustss ohci_device_bulk_close(usbd_pipe_handle pipe)
2956 1.3 augustss {
2957 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
2958 1.34 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
2959 1.3 augustss
2960 1.34 augustss DPRINTF(("ohci_device_bulk_close: pipe=%p\n", pipe));
2961 1.34 augustss ohci_close_pipe(pipe, sc->sc_bulk_head);
2962 1.60 augustss ohci_free_std(sc, opipe->tail.td);
2963 1.1 augustss }
2964 1.1 augustss
2965 1.1 augustss /************************/
2966 1.1 augustss
2967 1.82 augustss Static usbd_status
2968 1.91 augustss ohci_device_intr_transfer(usbd_xfer_handle xfer)
2969 1.17 augustss {
2970 1.53 augustss usbd_status err;
2971 1.17 augustss
2972 1.46 augustss /* Insert last in queue. */
2973 1.53 augustss err = usb_insert_transfer(xfer);
2974 1.53 augustss if (err)
2975 1.53 augustss return (err);
2976 1.46 augustss
2977 1.46 augustss /* Pipe isn't running, start first */
2978 1.53 augustss return (ohci_device_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue)));
2979 1.17 augustss }
2980 1.17 augustss
2981 1.82 augustss Static usbd_status
2982 1.91 augustss ohci_device_intr_start(usbd_xfer_handle xfer)
2983 1.1 augustss {
2984 1.53 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
2985 1.1 augustss usbd_device_handle dev = opipe->pipe.device;
2986 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
2987 1.1 augustss ohci_soft_ed_t *sed = opipe->sed;
2988 1.48 augustss ohci_soft_td_t *data, *tail;
2989 1.165 skrll int s, len, isread, endpt;
2990 1.1 augustss
2991 1.83 augustss if (sc->sc_dying)
2992 1.83 augustss return (USBD_IOERROR);
2993 1.83 augustss
2994 1.53 augustss DPRINTFN(3, ("ohci_device_intr_transfer: xfer=%p len=%d "
2995 1.14 augustss "flags=%d priv=%p\n",
2996 1.53 augustss xfer, xfer->length, xfer->flags, xfer->priv));
2997 1.1 augustss
2998 1.42 augustss #ifdef DIAGNOSTIC
2999 1.53 augustss if (xfer->rqflags & URQ_REQUEST)
3000 1.128 provos panic("ohci_device_intr_transfer: a request");
3001 1.42 augustss #endif
3002 1.1 augustss
3003 1.53 augustss len = xfer->length;
3004 1.165 skrll endpt = xfer->pipe->endpoint->edesc->bEndpointAddress;
3005 1.165 skrll isread = UE_GET_DIR(endpt) == UE_DIR_IN;
3006 1.1 augustss
3007 1.60 augustss data = opipe->tail.td;
3008 1.1 augustss tail = ohci_alloc_std(sc);
3009 1.55 augustss if (tail == NULL)
3010 1.43 augustss return (USBD_NOMEM);
3011 1.53 augustss tail->xfer = NULL;
3012 1.1 augustss
3013 1.168 augustss data->td.td_flags = HTOO32(
3014 1.165 skrll isread ? OHCI_TD_IN : OHCI_TD_OUT |
3015 1.165 skrll OHCI_TD_NOCC |
3016 1.16 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY);
3017 1.53 augustss if (xfer->flags & USBD_SHORT_XFER_OK)
3018 1.168 augustss data->td.td_flags |= HTOO32(OHCI_TD_R);
3019 1.168 augustss data->td.td_cbp = HTOO32(DMAADDR(&xfer->dmabuf, 0));
3020 1.48 augustss data->nexttd = tail;
3021 1.168 augustss data->td.td_nexttd = HTOO32(tail->physaddr);
3022 1.168 augustss data->td.td_be = HTOO32(O32TOH(data->td.td_cbp) + len - 1);
3023 1.48 augustss data->len = len;
3024 1.53 augustss data->xfer = xfer;
3025 1.48 augustss data->flags = OHCI_CALL_DONE | OHCI_ADD_LEN;
3026 1.53 augustss xfer->hcpriv = data;
3027 1.1 augustss
3028 1.52 augustss #ifdef OHCI_DEBUG
3029 1.1 augustss if (ohcidebug > 5) {
3030 1.41 augustss DPRINTF(("ohci_device_intr_transfer:\n"));
3031 1.168 augustss ohci_dump_ed(sc, sed);
3032 1.168 augustss ohci_dump_tds(sc, data);
3033 1.1 augustss }
3034 1.1 augustss #endif
3035 1.1 augustss
3036 1.1 augustss /* Insert ED in schedule */
3037 1.1 augustss s = splusb();
3038 1.168 augustss sed->ed.ed_tailp = HTOO32(tail->physaddr);
3039 1.60 augustss opipe->tail.td = tail;
3040 1.168 augustss sed->ed.ed_flags &= HTOO32(~OHCI_ED_SKIP);
3041 1.1 augustss
3042 1.52 augustss #if 0
3043 1.52 augustss /*
3044 1.52 augustss * This goes horribly wrong, printing thousands of descriptors,
3045 1.52 augustss * because false references are followed due to the fact that the
3046 1.52 augustss * TD is gone.
3047 1.52 augustss */
3048 1.1 augustss if (ohcidebug > 5) {
3049 1.55 augustss usb_delay_ms(&sc->sc_bus, 5);
3050 1.41 augustss DPRINTF(("ohci_device_intr_transfer: status=%x\n",
3051 1.41 augustss OREAD4(sc, OHCI_COMMAND_STATUS)));
3052 1.168 augustss ohci_dump_ed(sc, sed);
3053 1.168 augustss ohci_dump_tds(sc, data);
3054 1.1 augustss }
3055 1.1 augustss #endif
3056 1.26 augustss splx(s);
3057 1.1 augustss
3058 1.1 augustss return (USBD_IN_PROGRESS);
3059 1.1 augustss }
3060 1.1 augustss
3061 1.1 augustss /* Abort a device control request. */
3062 1.82 augustss Static void
3063 1.91 augustss ohci_device_intr_abort(usbd_xfer_handle xfer)
3064 1.1 augustss {
3065 1.53 augustss if (xfer->pipe->intrxfer == xfer) {
3066 1.1 augustss DPRINTF(("ohci_device_intr_abort: remove\n"));
3067 1.55 augustss xfer->pipe->intrxfer = NULL;
3068 1.1 augustss }
3069 1.54 augustss ohci_abort_xfer(xfer, USBD_CANCELLED);
3070 1.1 augustss }
3071 1.1 augustss
3072 1.1 augustss /* Close a device interrupt pipe. */
3073 1.82 augustss Static void
3074 1.91 augustss ohci_device_intr_close(usbd_pipe_handle pipe)
3075 1.1 augustss {
3076 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
3077 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
3078 1.1 augustss int nslots = opipe->u.intr.nslots;
3079 1.1 augustss int pos = opipe->u.intr.pos;
3080 1.1 augustss int j;
3081 1.1 augustss ohci_soft_ed_t *p, *sed = opipe->sed;
3082 1.1 augustss int s;
3083 1.1 augustss
3084 1.1 augustss DPRINTFN(1,("ohci_device_intr_close: pipe=%p nslots=%d pos=%d\n",
3085 1.1 augustss pipe, nslots, pos));
3086 1.1 augustss s = splusb();
3087 1.168 augustss sed->ed.ed_flags |= HTOO32(OHCI_ED_SKIP);
3088 1.168 augustss if ((O32TOH(sed->ed.ed_tailp) & OHCI_HEADMASK) !=
3089 1.168 augustss (O32TOH(sed->ed.ed_headp) & OHCI_HEADMASK))
3090 1.20 augustss usb_delay_ms(&sc->sc_bus, 2);
3091 1.1 augustss
3092 1.1 augustss for (p = sc->sc_eds[pos]; p && p->next != sed; p = p->next)
3093 1.1 augustss ;
3094 1.53 augustss #ifdef DIAGNOSTIC
3095 1.53 augustss if (p == NULL)
3096 1.128 provos panic("ohci_device_intr_close: ED not found");
3097 1.53 augustss #endif
3098 1.1 augustss p->next = sed->next;
3099 1.39 augustss p->ed.ed_nexted = sed->ed.ed_nexted;
3100 1.1 augustss splx(s);
3101 1.1 augustss
3102 1.1 augustss for (j = 0; j < nslots; j++)
3103 1.31 wrstuden --sc->sc_bws[(pos * nslots + j) % OHCI_NO_INTRS];
3104 1.1 augustss
3105 1.60 augustss ohci_free_std(sc, opipe->tail.td);
3106 1.1 augustss ohci_free_sed(sc, opipe->sed);
3107 1.1 augustss }
3108 1.1 augustss
3109 1.82 augustss Static usbd_status
3110 1.91 augustss ohci_device_setintr(ohci_softc_t *sc, struct ohci_pipe *opipe, int ival)
3111 1.1 augustss {
3112 1.1 augustss int i, j, s, best;
3113 1.1 augustss u_int npoll, slow, shigh, nslots;
3114 1.1 augustss u_int bestbw, bw;
3115 1.1 augustss ohci_soft_ed_t *hsed, *sed = opipe->sed;
3116 1.1 augustss
3117 1.1 augustss DPRINTFN(2, ("ohci_setintr: pipe=%p\n", opipe));
3118 1.1 augustss if (ival == 0) {
3119 1.1 augustss printf("ohci_setintr: 0 interval\n");
3120 1.1 augustss return (USBD_INVAL);
3121 1.1 augustss }
3122 1.1 augustss
3123 1.1 augustss npoll = OHCI_NO_INTRS;
3124 1.1 augustss while (npoll > ival)
3125 1.1 augustss npoll /= 2;
3126 1.1 augustss DPRINTFN(2, ("ohci_setintr: ival=%d npoll=%d\n", ival, npoll));
3127 1.1 augustss
3128 1.1 augustss /*
3129 1.1 augustss * We now know which level in the tree the ED must go into.
3130 1.1 augustss * Figure out which slot has most bandwidth left over.
3131 1.1 augustss * Slots to examine:
3132 1.1 augustss * npoll
3133 1.1 augustss * 1 0
3134 1.1 augustss * 2 1 2
3135 1.1 augustss * 4 3 4 5 6
3136 1.1 augustss * 8 7 8 9 10 11 12 13 14
3137 1.1 augustss * N (N-1) .. (N-1+N-1)
3138 1.1 augustss */
3139 1.1 augustss slow = npoll-1;
3140 1.1 augustss shigh = slow + npoll;
3141 1.1 augustss nslots = OHCI_NO_INTRS / npoll;
3142 1.1 augustss for (best = i = slow, bestbw = ~0; i < shigh; i++) {
3143 1.1 augustss bw = 0;
3144 1.1 augustss for (j = 0; j < nslots; j++)
3145 1.28 augustss bw += sc->sc_bws[(i * nslots + j) % OHCI_NO_INTRS];
3146 1.1 augustss if (bw < bestbw) {
3147 1.1 augustss best = i;
3148 1.1 augustss bestbw = bw;
3149 1.1 augustss }
3150 1.1 augustss }
3151 1.120 augustss DPRINTFN(2, ("ohci_setintr: best=%d(%d..%d) bestbw=%d\n",
3152 1.1 augustss best, slow, shigh, bestbw));
3153 1.1 augustss
3154 1.1 augustss s = splusb();
3155 1.1 augustss hsed = sc->sc_eds[best];
3156 1.1 augustss sed->next = hsed->next;
3157 1.39 augustss sed->ed.ed_nexted = hsed->ed.ed_nexted;
3158 1.1 augustss hsed->next = sed;
3159 1.168 augustss hsed->ed.ed_nexted = HTOO32(sed->physaddr);
3160 1.1 augustss splx(s);
3161 1.1 augustss
3162 1.1 augustss for (j = 0; j < nslots; j++)
3163 1.28 augustss ++sc->sc_bws[(best * nslots + j) % OHCI_NO_INTRS];
3164 1.1 augustss opipe->u.intr.nslots = nslots;
3165 1.1 augustss opipe->u.intr.pos = best;
3166 1.1 augustss
3167 1.1 augustss DPRINTFN(5, ("ohci_setintr: returns %p\n", opipe));
3168 1.1 augustss return (USBD_NORMAL_COMPLETION);
3169 1.60 augustss }
3170 1.60 augustss
3171 1.60 augustss /***********************/
3172 1.60 augustss
3173 1.60 augustss usbd_status
3174 1.91 augustss ohci_device_isoc_transfer(usbd_xfer_handle xfer)
3175 1.60 augustss {
3176 1.60 augustss usbd_status err;
3177 1.60 augustss
3178 1.60 augustss DPRINTFN(5,("ohci_device_isoc_transfer: xfer=%p\n", xfer));
3179 1.60 augustss
3180 1.60 augustss /* Put it on our queue, */
3181 1.60 augustss err = usb_insert_transfer(xfer);
3182 1.60 augustss
3183 1.60 augustss /* bail out on error, */
3184 1.60 augustss if (err && err != USBD_IN_PROGRESS)
3185 1.60 augustss return (err);
3186 1.60 augustss
3187 1.60 augustss /* XXX should check inuse here */
3188 1.60 augustss
3189 1.60 augustss /* insert into schedule, */
3190 1.60 augustss ohci_device_isoc_enter(xfer);
3191 1.60 augustss
3192 1.83 augustss /* and start if the pipe wasn't running */
3193 1.60 augustss if (!err)
3194 1.60 augustss ohci_device_isoc_start(SIMPLEQ_FIRST(&xfer->pipe->queue));
3195 1.60 augustss
3196 1.60 augustss return (err);
3197 1.60 augustss }
3198 1.60 augustss
3199 1.60 augustss void
3200 1.91 augustss ohci_device_isoc_enter(usbd_xfer_handle xfer)
3201 1.60 augustss {
3202 1.61 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
3203 1.61 augustss usbd_device_handle dev = opipe->pipe.device;
3204 1.61 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
3205 1.61 augustss ohci_soft_ed_t *sed = opipe->sed;
3206 1.61 augustss struct iso *iso = &opipe->u.iso;
3207 1.120 augustss ohci_soft_itd_t *sitd, *nsitd;
3208 1.83 augustss ohci_physaddr_t buf, offs, noffs, bp0;
3209 1.61 augustss int i, ncur, nframes;
3210 1.61 augustss int s;
3211 1.61 augustss
3212 1.83 augustss DPRINTFN(1,("ohci_device_isoc_enter: used=%d next=%d xfer=%p "
3213 1.83 augustss "nframes=%d\n",
3214 1.83 augustss iso->inuse, iso->next, xfer, xfer->nframes));
3215 1.83 augustss
3216 1.83 augustss if (sc->sc_dying)
3217 1.83 augustss return;
3218 1.83 augustss
3219 1.83 augustss if (iso->next == -1) {
3220 1.83 augustss /* Not in use yet, schedule it a few frames ahead. */
3221 1.168 augustss iso->next = O32TOH(sc->sc_hcca->hcca_frame_number) + 5;
3222 1.120 augustss DPRINTFN(2,("ohci_device_isoc_enter: start next=%d\n",
3223 1.83 augustss iso->next));
3224 1.83 augustss }
3225 1.83 augustss
3226 1.61 augustss sitd = opipe->tail.itd;
3227 1.125 augustss buf = DMAADDR(&xfer->dmabuf, 0);
3228 1.83 augustss bp0 = OHCI_PAGE(buf);
3229 1.83 augustss offs = OHCI_PAGE_OFFSET(buf);
3230 1.61 augustss nframes = xfer->nframes;
3231 1.83 augustss xfer->hcpriv = sitd;
3232 1.61 augustss for (i = ncur = 0; i < nframes; i++, ncur++) {
3233 1.83 augustss noffs = offs + xfer->frlengths[i];
3234 1.61 augustss if (ncur == OHCI_ITD_NOFFSET || /* all offsets used */
3235 1.83 augustss OHCI_PAGE(buf + noffs) > bp0 + OHCI_PAGE_SIZE) { /* too many page crossings */
3236 1.120 augustss
3237 1.83 augustss /* Allocate next ITD */
3238 1.61 augustss nsitd = ohci_alloc_sitd(sc);
3239 1.61 augustss if (nsitd == NULL) {
3240 1.61 augustss /* XXX what now? */
3241 1.83 augustss printf("%s: isoc TD alloc failed\n",
3242 1.83 augustss USBDEVNAME(sc->sc_bus.bdev));
3243 1.61 augustss return;
3244 1.61 augustss }
3245 1.83 augustss
3246 1.83 augustss /* Fill current ITD */
3247 1.168 augustss sitd->itd.itd_flags = HTOO32(
3248 1.120 augustss OHCI_ITD_NOCC |
3249 1.61 augustss OHCI_ITD_SET_SF(iso->next) |
3250 1.83 augustss OHCI_ITD_SET_DI(6) | /* delay intr a little */
3251 1.83 augustss OHCI_ITD_SET_FC(ncur));
3252 1.168 augustss sitd->itd.itd_bp0 = HTOO32(bp0);
3253 1.83 augustss sitd->nextitd = nsitd;
3254 1.168 augustss sitd->itd.itd_nextitd = HTOO32(nsitd->physaddr);
3255 1.168 augustss sitd->itd.itd_be = HTOO32(bp0 + offs - 1);
3256 1.83 augustss sitd->xfer = xfer;
3257 1.83 augustss sitd->flags = 0;
3258 1.83 augustss
3259 1.61 augustss sitd = nsitd;
3260 1.120 augustss iso->next = iso->next + ncur;
3261 1.83 augustss bp0 = OHCI_PAGE(buf + offs);
3262 1.61 augustss ncur = 0;
3263 1.61 augustss }
3264 1.168 augustss sitd->itd.itd_offset[ncur] = HTOO16(OHCI_ITD_MK_OFFS(offs));
3265 1.83 augustss offs = noffs;
3266 1.61 augustss }
3267 1.61 augustss nsitd = ohci_alloc_sitd(sc);
3268 1.61 augustss if (nsitd == NULL) {
3269 1.61 augustss /* XXX what now? */
3270 1.120 augustss printf("%s: isoc TD alloc failed\n",
3271 1.83 augustss USBDEVNAME(sc->sc_bus.bdev));
3272 1.61 augustss return;
3273 1.61 augustss }
3274 1.83 augustss /* Fixup last used ITD */
3275 1.168 augustss sitd->itd.itd_flags = HTOO32(
3276 1.120 augustss OHCI_ITD_NOCC |
3277 1.61 augustss OHCI_ITD_SET_SF(iso->next) |
3278 1.61 augustss OHCI_ITD_SET_DI(0) |
3279 1.61 augustss OHCI_ITD_SET_FC(ncur));
3280 1.168 augustss sitd->itd.itd_bp0 = HTOO32(bp0);
3281 1.83 augustss sitd->nextitd = nsitd;
3282 1.168 augustss sitd->itd.itd_nextitd = HTOO32(nsitd->physaddr);
3283 1.168 augustss sitd->itd.itd_be = HTOO32(bp0 + offs - 1);
3284 1.83 augustss sitd->xfer = xfer;
3285 1.83 augustss sitd->flags = OHCI_CALL_DONE;
3286 1.83 augustss
3287 1.61 augustss iso->next = iso->next + ncur;
3288 1.83 augustss iso->inuse += nframes;
3289 1.83 augustss
3290 1.83 augustss xfer->actlen = offs; /* XXX pretend we did it all */
3291 1.83 augustss
3292 1.83 augustss xfer->status = USBD_IN_PROGRESS;
3293 1.83 augustss
3294 1.83 augustss #ifdef OHCI_DEBUG
3295 1.83 augustss if (ohcidebug > 5) {
3296 1.83 augustss DPRINTF(("ohci_device_isoc_enter: frame=%d\n",
3297 1.168 augustss O32TOH(sc->sc_hcca->hcca_frame_number)));
3298 1.168 augustss ohci_dump_itds(sc, xfer->hcpriv);
3299 1.168 augustss ohci_dump_ed(sc, sed);
3300 1.83 augustss }
3301 1.83 augustss #endif
3302 1.61 augustss
3303 1.83 augustss s = splusb();
3304 1.168 augustss sed->ed.ed_tailp = HTOO32(nsitd->physaddr);
3305 1.61 augustss opipe->tail.itd = nsitd;
3306 1.168 augustss sed->ed.ed_flags &= HTOO32(~OHCI_ED_SKIP);
3307 1.61 augustss splx(s);
3308 1.83 augustss
3309 1.83 augustss #ifdef OHCI_DEBUG
3310 1.83 augustss if (ohcidebug > 5) {
3311 1.83 augustss delay(150000);
3312 1.83 augustss DPRINTF(("ohci_device_isoc_enter: after frame=%d\n",
3313 1.168 augustss O32TOH(sc->sc_hcca->hcca_frame_number)));
3314 1.168 augustss ohci_dump_itds(sc, xfer->hcpriv);
3315 1.168 augustss ohci_dump_ed(sc, sed);
3316 1.83 augustss }
3317 1.83 augustss #endif
3318 1.60 augustss }
3319 1.60 augustss
3320 1.60 augustss usbd_status
3321 1.91 augustss ohci_device_isoc_start(usbd_xfer_handle xfer)
3322 1.60 augustss {
3323 1.83 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
3324 1.83 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
3325 1.83 augustss
3326 1.83 augustss DPRINTFN(5,("ohci_device_isoc_start: xfer=%p\n", xfer));
3327 1.83 augustss
3328 1.83 augustss if (sc->sc_dying)
3329 1.83 augustss return (USBD_IOERROR);
3330 1.83 augustss
3331 1.83 augustss #ifdef DIAGNOSTIC
3332 1.83 augustss if (xfer->status != USBD_IN_PROGRESS)
3333 1.121 tsutsui printf("ohci_device_isoc_start: not in progress %p\n", xfer);
3334 1.83 augustss #endif
3335 1.83 augustss
3336 1.83 augustss /* XXX anything to do? */
3337 1.83 augustss
3338 1.83 augustss return (USBD_IN_PROGRESS);
3339 1.60 augustss }
3340 1.60 augustss
3341 1.60 augustss void
3342 1.91 augustss ohci_device_isoc_abort(usbd_xfer_handle xfer)
3343 1.60 augustss {
3344 1.83 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)xfer->pipe;
3345 1.83 augustss ohci_softc_t *sc = (ohci_softc_t *)opipe->pipe.device->bus;
3346 1.83 augustss ohci_soft_ed_t *sed;
3347 1.83 augustss ohci_soft_itd_t *sitd;
3348 1.83 augustss int s;
3349 1.83 augustss
3350 1.83 augustss s = splusb();
3351 1.83 augustss
3352 1.83 augustss DPRINTFN(1,("ohci_device_isoc_abort: xfer=%p\n", xfer));
3353 1.83 augustss
3354 1.83 augustss /* Transfer is already done. */
3355 1.120 augustss if (xfer->status != USBD_NOT_STARTED &&
3356 1.83 augustss xfer->status != USBD_IN_PROGRESS) {
3357 1.83 augustss splx(s);
3358 1.83 augustss printf("ohci_device_isoc_abort: early return\n");
3359 1.83 augustss return;
3360 1.83 augustss }
3361 1.83 augustss
3362 1.83 augustss /* Give xfer the requested abort code. */
3363 1.83 augustss xfer->status = USBD_CANCELLED;
3364 1.83 augustss
3365 1.83 augustss sed = opipe->sed;
3366 1.168 augustss sed->ed.ed_flags |= HTOO32(OHCI_ED_SKIP); /* force hardware skip */
3367 1.83 augustss
3368 1.83 augustss sitd = xfer->hcpriv;
3369 1.83 augustss #ifdef DIAGNOSTIC
3370 1.83 augustss if (sitd == NULL) {
3371 1.102 augustss splx(s);
3372 1.83 augustss printf("ohci_device_isoc_abort: hcpriv==0\n");
3373 1.83 augustss return;
3374 1.83 augustss }
3375 1.83 augustss #endif
3376 1.83 augustss for (; sitd->xfer == xfer; sitd = sitd->nextitd) {
3377 1.83 augustss #ifdef DIAGNOSTIC
3378 1.83 augustss DPRINTFN(1,("abort sets done sitd=%p\n", sitd));
3379 1.83 augustss sitd->isdone = 1;
3380 1.83 augustss #endif
3381 1.83 augustss }
3382 1.83 augustss
3383 1.83 augustss splx(s);
3384 1.83 augustss
3385 1.83 augustss usb_delay_ms(&sc->sc_bus, OHCI_ITD_NOFFSET);
3386 1.83 augustss
3387 1.83 augustss s = splusb();
3388 1.83 augustss
3389 1.83 augustss /* Run callback. */
3390 1.83 augustss usb_transfer_complete(xfer);
3391 1.83 augustss
3392 1.168 augustss sed->ed.ed_headp = HTOO32(sitd->physaddr); /* unlink TDs */
3393 1.168 augustss sed->ed.ed_flags &= HTOO32(~OHCI_ED_SKIP); /* remove hardware skip */
3394 1.83 augustss
3395 1.83 augustss splx(s);
3396 1.60 augustss }
3397 1.60 augustss
3398 1.60 augustss void
3399 1.91 augustss ohci_device_isoc_done(usbd_xfer_handle xfer)
3400 1.60 augustss {
3401 1.83 augustss DPRINTFN(1,("ohci_device_isoc_done: xfer=%p\n", xfer));
3402 1.60 augustss }
3403 1.60 augustss
3404 1.60 augustss usbd_status
3405 1.91 augustss ohci_setup_isoc(usbd_pipe_handle pipe)
3406 1.60 augustss {
3407 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
3408 1.83 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
3409 1.60 augustss struct iso *iso = &opipe->u.iso;
3410 1.83 augustss int s;
3411 1.60 augustss
3412 1.60 augustss iso->next = -1;
3413 1.60 augustss iso->inuse = 0;
3414 1.60 augustss
3415 1.83 augustss s = splusb();
3416 1.168 augustss ohci_add_ed(sc, opipe->sed, sc->sc_isoc_head);
3417 1.83 augustss splx(s);
3418 1.83 augustss
3419 1.60 augustss return (USBD_NORMAL_COMPLETION);
3420 1.60 augustss }
3421 1.60 augustss
3422 1.60 augustss void
3423 1.91 augustss ohci_device_isoc_close(usbd_pipe_handle pipe)
3424 1.60 augustss {
3425 1.60 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
3426 1.60 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
3427 1.60 augustss
3428 1.60 augustss DPRINTF(("ohci_device_isoc_close: pipe=%p\n", pipe));
3429 1.60 augustss ohci_close_pipe(pipe, sc->sc_isoc_head);
3430 1.83 augustss #ifdef DIAGNOSTIC
3431 1.83 augustss opipe->tail.itd->isdone = 1;
3432 1.83 augustss #endif
3433 1.60 augustss ohci_free_sitd(sc, opipe->tail.itd);
3434 1.1 augustss }
3435