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