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