ohci.c revision 1.7 1 1.7 augustss /* $NetBSD: ohci.c,v 1.7 1998/08/02 22:30:52 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.1 augustss panic("uhci_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.1 augustss /* Update device address */
898 1.1 augustss sed->ed->ed_flags =
899 1.1 augustss (sed->ed->ed_flags & ~OHCI_ED_ADDRMASK) |
900 1.1 augustss OHCI_ED_SET_FA(addr);
901 1.1 augustss
902 1.1 augustss /* Set up data transaction */
903 1.1 augustss if (len != 0) {
904 1.1 augustss xfer = ohci_alloc_std(sc);
905 1.1 augustss if (!xfer) {
906 1.1 augustss r = USBD_NOMEM;
907 1.1 augustss goto bad3;
908 1.1 augustss }
909 1.4 augustss r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
910 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
911 1.1 augustss goto bad4;
912 1.1 augustss xfer->td->td_flags =
913 1.1 augustss (isread ? OHCI_TD_IN : OHCI_TD_OUT) | OHCI_TD_NOCC |
914 1.1 augustss OHCI_TD_TOGGLE_1 | OHCI_TD_NOINTR;
915 1.1 augustss xfer->td->td_cbp = DMAADDR(dmap);
916 1.1 augustss xfer->nexttd = stat;
917 1.1 augustss xfer->td->td_nexttd = stat->physaddr;
918 1.1 augustss xfer->td->td_be = xfer->td->td_cbp + len - 1;
919 1.1 augustss xfer->len = len;
920 1.1 augustss xfer->reqh = reqh;
921 1.1 augustss
922 1.1 augustss next = xfer;
923 1.1 augustss } else
924 1.1 augustss next = stat;
925 1.1 augustss
926 1.1 augustss memcpy(KERNADDR(&opipe->u.ctl.reqdma), req, sizeof *req);
927 1.1 augustss if (!isread && len != 0)
928 1.1 augustss memcpy(KERNADDR(dmap), reqh->buffer, len);
929 1.1 augustss
930 1.1 augustss setup->td->td_flags = OHCI_TD_SETUP | OHCI_TD_NOCC |
931 1.1 augustss OHCI_TD_TOGGLE_0 | OHCI_TD_NOINTR;
932 1.1 augustss setup->td->td_cbp = DMAADDR(&opipe->u.ctl.reqdma);
933 1.1 augustss setup->nexttd = next;
934 1.1 augustss setup->td->td_nexttd = next->physaddr;
935 1.1 augustss setup->td->td_be = setup->td->td_cbp + sizeof *req - 1;
936 1.1 augustss setup->len = 0; /* XXX The number of byte we count */
937 1.1 augustss setup->reqh = reqh;
938 1.1 augustss
939 1.1 augustss stat->td->td_flags =
940 1.1 augustss (isread ? OHCI_TD_OUT : OHCI_TD_IN) | OHCI_TD_NOCC |
941 1.1 augustss OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1);
942 1.1 augustss stat->td->td_cbp = 0;
943 1.1 augustss stat->nexttd = tail;
944 1.1 augustss stat->td->td_nexttd = tail->physaddr;
945 1.1 augustss stat->td->td_be = 0;
946 1.1 augustss stat->len = 0;
947 1.1 augustss stat->reqh = reqh;
948 1.1 augustss
949 1.1 augustss reqh->actlen = 0;
950 1.1 augustss reqh->hcpriv = stat;
951 1.1 augustss
952 1.1 augustss #if USB_DEBUG
953 1.1 augustss if (ohcidebug > 5) {
954 1.1 augustss printf("ohci_device_request:\n");
955 1.1 augustss ohci_dump_ed(sed);
956 1.1 augustss ohci_dump_tds(setup);
957 1.1 augustss }
958 1.1 augustss #endif
959 1.1 augustss
960 1.1 augustss /* Insert ED in schedule */
961 1.1 augustss s = splusb();
962 1.1 augustss ohci_hash_add_td(sc, setup);
963 1.1 augustss if (len != 0)
964 1.1 augustss ohci_hash_add_td(sc, xfer);
965 1.1 augustss ohci_hash_add_td(sc, stat);
966 1.1 augustss sed->ed->ed_tailp = tail->physaddr;
967 1.1 augustss opipe->tail = tail;
968 1.1 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF);
969 1.6 augustss if (reqh->timeout && !sc->sc_bus.use_polling)
970 1.1 augustss timeout(ohci_timeout, reqh, MS_TO_TICKS(reqh->timeout));
971 1.1 augustss splx(s);
972 1.1 augustss
973 1.1 augustss #if USB_DEBUG
974 1.1 augustss if (ohcidebug > 5) {
975 1.1 augustss delay(5000);
976 1.1 augustss printf("ohci_device_request: status=%x\n",
977 1.1 augustss OREAD4(sc, OHCI_COMMAND_STATUS));
978 1.1 augustss ohci_dump_ed(sed);
979 1.1 augustss ohci_dump_tds(setup);
980 1.1 augustss }
981 1.1 augustss #endif
982 1.1 augustss
983 1.1 augustss return (USBD_NORMAL_COMPLETION);
984 1.1 augustss
985 1.1 augustss bad4:
986 1.1 augustss ohci_free_std(sc, xfer);
987 1.1 augustss bad3:
988 1.1 augustss ohci_free_std(sc, tail);
989 1.1 augustss bad2:
990 1.1 augustss ohci_free_std(sc, stat);
991 1.1 augustss bad1:
992 1.1 augustss return (r);
993 1.1 augustss }
994 1.1 augustss
995 1.1 augustss /*
996 1.1 augustss * Add an ED to the schedule. Called at splusb().
997 1.1 augustss */
998 1.1 augustss void
999 1.3 augustss ohci_add_ed(sed, head)
1000 1.1 augustss ohci_soft_ed_t *sed;
1001 1.1 augustss ohci_soft_ed_t *head;
1002 1.1 augustss {
1003 1.1 augustss sed->next = head->next;
1004 1.1 augustss sed->ed->ed_nexted = head->ed->ed_nexted;
1005 1.1 augustss head->next = sed;
1006 1.1 augustss head->ed->ed_nexted = sed->physaddr;
1007 1.1 augustss }
1008 1.1 augustss
1009 1.1 augustss /*
1010 1.3 augustss * Remove an ED from the schedule. Called at splusb().
1011 1.3 augustss */
1012 1.3 augustss void
1013 1.3 augustss ohci_rem_ed(sed, head)
1014 1.3 augustss ohci_soft_ed_t *sed;
1015 1.3 augustss ohci_soft_ed_t *head;
1016 1.3 augustss {
1017 1.3 augustss ohci_soft_ed_t *p;
1018 1.3 augustss
1019 1.3 augustss /* XXX */
1020 1.3 augustss for (p = head; p && p->next != sed; p = p->next)
1021 1.3 augustss ;
1022 1.3 augustss if (!p)
1023 1.3 augustss panic("ohci_rem_ed: ED not found\n");
1024 1.3 augustss p->next = sed->next;
1025 1.3 augustss p->ed->ed_nexted = sed->ed->ed_nexted;
1026 1.3 augustss }
1027 1.3 augustss
1028 1.3 augustss /*
1029 1.1 augustss * When a transfer is completed the TD is added to the done queue by
1030 1.1 augustss * the host controller. This queue is the processed by software.
1031 1.1 augustss * Unfortunately the queue contains the physical address of the TD
1032 1.1 augustss * and we have no simple way to translate this back a kernel address.
1033 1.1 augustss * To make the translation possible (and fast) we use a hash table of
1034 1.1 augustss * TDs currently in the schedule. The physical address is used as the
1035 1.1 augustss * hash value.
1036 1.1 augustss */
1037 1.1 augustss
1038 1.1 augustss #define HASH(a) (((a) >> 4) % OHCI_HASH_SIZE)
1039 1.1 augustss /* Called at splusb() */
1040 1.1 augustss void
1041 1.1 augustss ohci_hash_add_td(sc, std)
1042 1.1 augustss ohci_softc_t *sc;
1043 1.1 augustss ohci_soft_td_t *std;
1044 1.1 augustss {
1045 1.1 augustss int h = HASH(std->physaddr);
1046 1.1 augustss
1047 1.1 augustss LIST_INSERT_HEAD(&sc->sc_hash_tds[h], std, hnext);
1048 1.1 augustss }
1049 1.1 augustss
1050 1.1 augustss /* Called at splusb() */
1051 1.1 augustss void
1052 1.1 augustss ohci_hash_rem_td(sc, std)
1053 1.1 augustss ohci_softc_t *sc;
1054 1.1 augustss ohci_soft_td_t *std;
1055 1.1 augustss {
1056 1.1 augustss LIST_REMOVE(std, hnext);
1057 1.1 augustss }
1058 1.1 augustss
1059 1.1 augustss ohci_soft_td_t *
1060 1.1 augustss ohci_hash_find_td(sc, a)
1061 1.1 augustss ohci_softc_t *sc;
1062 1.1 augustss ohci_physaddr_t a;
1063 1.1 augustss {
1064 1.1 augustss int h = HASH(a);
1065 1.1 augustss ohci_soft_td_t *std;
1066 1.1 augustss
1067 1.1 augustss for (std = LIST_FIRST(&sc->sc_hash_tds[h]);
1068 1.1 augustss std != 0;
1069 1.1 augustss std = LIST_NEXT(std, hnext))
1070 1.1 augustss if (std->physaddr == a)
1071 1.1 augustss return (std);
1072 1.1 augustss panic("ohci_hash_find_td: addr 0x%08lx not found\n", (u_long)a);
1073 1.1 augustss }
1074 1.1 augustss
1075 1.1 augustss void
1076 1.1 augustss ohci_timeout(addr)
1077 1.1 augustss void *addr;
1078 1.1 augustss {
1079 1.1 augustss #if 0
1080 1.1 augustss usbd_request_handle *reqh = addr;
1081 1.1 augustss int s;
1082 1.1 augustss
1083 1.1 augustss DPRINTF(("ohci_timeout: reqh=%p\n", reqh));
1084 1.1 augustss s = splusb();
1085 1.1 augustss /* XXX need to inactivate TD before calling interrupt routine */
1086 1.1 augustss ohci_XXX_done(reqh);
1087 1.1 augustss splx(s);
1088 1.1 augustss #endif
1089 1.1 augustss }
1090 1.1 augustss
1091 1.1 augustss #ifdef USB_DEBUG
1092 1.1 augustss void
1093 1.1 augustss ohci_dump_tds(std)
1094 1.1 augustss ohci_soft_td_t *std;
1095 1.1 augustss {
1096 1.1 augustss for (; std; std = std->nexttd)
1097 1.1 augustss ohci_dump_td(std);
1098 1.1 augustss }
1099 1.1 augustss
1100 1.1 augustss void
1101 1.1 augustss ohci_dump_td(std)
1102 1.1 augustss ohci_soft_td_t *std;
1103 1.1 augustss {
1104 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",
1105 1.1 augustss std, (u_long)std->physaddr,
1106 1.1 augustss (u_long)std->td->td_flags,
1107 1.1 augustss "\20\23R\24OUT\25IN\31TOG1\32SETTOGGLE",
1108 1.1 augustss OHCI_TD_GET_DI(std->td->td_flags),
1109 1.1 augustss OHCI_TD_GET_EC(std->td->td_flags),
1110 1.1 augustss OHCI_TD_GET_CC(std->td->td_flags),
1111 1.1 augustss (u_long)std->td->td_cbp,
1112 1.1 augustss (u_long)std->td->td_nexttd, (u_long)std->td->td_be);
1113 1.1 augustss }
1114 1.1 augustss
1115 1.1 augustss void
1116 1.1 augustss ohci_dump_ed(sed)
1117 1.1 augustss ohci_soft_ed_t *sed;
1118 1.1 augustss {
1119 1.1 augustss printf("ED(%p) at %08lx: addr=%d endpt=%d maxp=%d %b\ntailp=0x%08lx headp=%b nexted=0x%08lx\n",
1120 1.1 augustss sed, (u_long)sed->physaddr,
1121 1.1 augustss OHCI_ED_GET_FA(sed->ed->ed_flags),
1122 1.1 augustss OHCI_ED_GET_EN(sed->ed->ed_flags),
1123 1.1 augustss OHCI_ED_GET_MAXP(sed->ed->ed_flags),
1124 1.1 augustss (u_long)sed->ed->ed_flags,
1125 1.1 augustss "\20\14OUT\15IN\16LOWSPEED\17SKIP\18ISO",
1126 1.1 augustss (u_long)sed->ed->ed_tailp,
1127 1.1 augustss (u_long)sed->ed->ed_headp, "\20\1HALT\2CARRY",
1128 1.1 augustss (u_long)sed->ed->ed_nexted);
1129 1.1 augustss }
1130 1.1 augustss #endif
1131 1.1 augustss
1132 1.1 augustss usbd_status
1133 1.1 augustss ohci_open(pipe)
1134 1.1 augustss usbd_pipe_handle pipe;
1135 1.1 augustss {
1136 1.1 augustss usbd_device_handle dev = pipe->device;
1137 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1138 1.1 augustss usb_endpoint_descriptor_t *ed = pipe->endpoint->edesc;
1139 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1140 1.1 augustss u_int8_t addr = dev->address;
1141 1.1 augustss ohci_soft_ed_t *sed;
1142 1.1 augustss ohci_soft_td_t *std;
1143 1.1 augustss usbd_status r;
1144 1.1 augustss int s;
1145 1.1 augustss
1146 1.1 augustss DPRINTFN(1, ("ohci_open: pipe=%p, addr=%d, endpt=%d (%d)\n",
1147 1.1 augustss pipe, addr, ed->bEndpointAddress, sc->sc_addr));
1148 1.1 augustss if (addr == sc->sc_addr) {
1149 1.1 augustss switch (ed->bEndpointAddress) {
1150 1.1 augustss case USB_CONTROL_ENDPOINT:
1151 1.1 augustss pipe->methods = &ohci_root_ctrl_methods;
1152 1.1 augustss break;
1153 1.1 augustss case UE_IN | OHCI_INTR_ENDPT:
1154 1.1 augustss pipe->methods = &ohci_root_intr_methods;
1155 1.1 augustss break;
1156 1.1 augustss default:
1157 1.1 augustss return (USBD_INVAL);
1158 1.1 augustss }
1159 1.1 augustss } else {
1160 1.1 augustss sed = ohci_alloc_sed(sc);
1161 1.1 augustss if (sed == 0)
1162 1.1 augustss goto bad0;
1163 1.1 augustss std = ohci_alloc_std(sc);
1164 1.1 augustss if (std == 0)
1165 1.1 augustss goto bad1;
1166 1.1 augustss opipe->sed = sed;
1167 1.1 augustss opipe->tail = std;
1168 1.1 augustss sed->ed->ed_flags =
1169 1.1 augustss OHCI_ED_SET_FA(addr) |
1170 1.1 augustss OHCI_ED_SET_EN(ed->bEndpointAddress) |
1171 1.1 augustss OHCI_ED_DIR_TD |
1172 1.1 augustss (dev->lowspeed ? OHCI_ED_SPEED : 0) |
1173 1.1 augustss ((ed->bmAttributes & UE_XFERTYPE) == UE_ISOCHRONOUS ?
1174 1.1 augustss OHCI_ED_FORMAT_ISO : OHCI_ED_FORMAT_GEN) |
1175 1.2 augustss OHCI_ED_SET_MAXP(UGETW(pipe->endpoint->edesc->wMaxPacketSize));
1176 1.1 augustss sed->ed->ed_headp = sed->ed->ed_tailp = std->physaddr;
1177 1.1 augustss
1178 1.1 augustss switch (ed->bmAttributes & UE_XFERTYPE) {
1179 1.1 augustss case UE_CONTROL:
1180 1.1 augustss pipe->methods = &ohci_device_ctrl_methods;
1181 1.4 augustss r = usb_allocmem(sc->sc_dmatag,
1182 1.4 augustss sizeof(usb_device_request_t),
1183 1.4 augustss 0, &opipe->u.ctl.reqdma);
1184 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1185 1.1 augustss goto bad;
1186 1.1 augustss s = splusb();
1187 1.3 augustss ohci_add_ed(sed, sc->sc_ctrl_head);
1188 1.1 augustss splx(s);
1189 1.1 augustss break;
1190 1.1 augustss case UE_INTERRUPT:
1191 1.1 augustss pipe->methods = &ohci_device_intr_methods;
1192 1.1 augustss return (ohci_device_setintr(sc, opipe, ed->bInterval));
1193 1.1 augustss case UE_ISOCHRONOUS:
1194 1.1 augustss printf("ohci_open: open iso unimplemented\n");
1195 1.1 augustss return (USBD_XXX);
1196 1.1 augustss case UE_BULK:
1197 1.3 augustss pipe->methods = &ohci_device_bulk_methods;
1198 1.3 augustss s = splusb();
1199 1.3 augustss ohci_add_ed(sed, sc->sc_bulk_head);
1200 1.3 augustss splx(s);
1201 1.3 augustss break;
1202 1.1 augustss }
1203 1.1 augustss }
1204 1.1 augustss return (USBD_NORMAL_COMPLETION);
1205 1.1 augustss
1206 1.1 augustss bad:
1207 1.1 augustss ohci_free_std(sc, std);
1208 1.1 augustss bad1:
1209 1.1 augustss ohci_free_sed(sc, sed);
1210 1.1 augustss bad0:
1211 1.1 augustss return (USBD_NOMEM);
1212 1.1 augustss
1213 1.1 augustss }
1214 1.1 augustss
1215 1.1 augustss /*
1216 1.1 augustss * Data structures and routines to emulate the root hub.
1217 1.1 augustss */
1218 1.1 augustss usb_device_descriptor_t ohci_devd = {
1219 1.1 augustss USB_DEVICE_DESCRIPTOR_SIZE,
1220 1.1 augustss UDESC_DEVICE, /* type */
1221 1.1 augustss {0x00, 0x01}, /* USB version */
1222 1.1 augustss UCLASS_HUB, /* class */
1223 1.1 augustss USUBCLASS_HUB, /* subclass */
1224 1.1 augustss 0, /* protocol */
1225 1.1 augustss 64, /* max packet */
1226 1.1 augustss {0},{0},{0x00,0x01}, /* device id */
1227 1.1 augustss 1,2,0, /* string indicies */
1228 1.1 augustss 1 /* # of configurations */
1229 1.1 augustss };
1230 1.1 augustss
1231 1.1 augustss usb_config_descriptor_t ohci_confd = {
1232 1.1 augustss USB_CONFIG_DESCRIPTOR_SIZE,
1233 1.1 augustss UDESC_CONFIG,
1234 1.1 augustss {USB_CONFIG_DESCRIPTOR_SIZE +
1235 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE +
1236 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE},
1237 1.1 augustss 1,
1238 1.1 augustss 1,
1239 1.1 augustss 0,
1240 1.1 augustss UC_SELF_POWERED,
1241 1.1 augustss 0 /* max power */
1242 1.1 augustss };
1243 1.1 augustss
1244 1.1 augustss usb_interface_descriptor_t ohci_ifcd = {
1245 1.1 augustss USB_INTERFACE_DESCRIPTOR_SIZE,
1246 1.1 augustss UDESC_INTERFACE,
1247 1.1 augustss 0,
1248 1.1 augustss 0,
1249 1.1 augustss 1,
1250 1.1 augustss UCLASS_HUB,
1251 1.1 augustss USUBCLASS_HUB,
1252 1.1 augustss 0,
1253 1.1 augustss 0
1254 1.1 augustss };
1255 1.1 augustss
1256 1.1 augustss usb_endpoint_descriptor_t ohci_endpd = {
1257 1.1 augustss USB_ENDPOINT_DESCRIPTOR_SIZE,
1258 1.1 augustss UDESC_ENDPOINT,
1259 1.1 augustss UE_IN | OHCI_INTR_ENDPT,
1260 1.1 augustss UE_INTERRUPT,
1261 1.1 augustss {8, 0}, /* max packet */
1262 1.1 augustss 255
1263 1.1 augustss };
1264 1.1 augustss
1265 1.1 augustss usb_hub_descriptor_t ohci_hubd = {
1266 1.1 augustss USB_HUB_DESCRIPTOR_SIZE,
1267 1.1 augustss UDESC_HUB,
1268 1.1 augustss 0,
1269 1.1 augustss {0,0},
1270 1.1 augustss 0,
1271 1.1 augustss 0,
1272 1.1 augustss {0},
1273 1.1 augustss {0},
1274 1.1 augustss };
1275 1.1 augustss
1276 1.1 augustss int
1277 1.1 augustss ohci_str(p, l, s)
1278 1.1 augustss usb_string_descriptor_t *p;
1279 1.1 augustss int l;
1280 1.1 augustss char *s;
1281 1.1 augustss {
1282 1.1 augustss int i;
1283 1.1 augustss
1284 1.1 augustss if (l == 0)
1285 1.1 augustss return (0);
1286 1.1 augustss p->bLength = 2 * strlen(s) + 2;
1287 1.1 augustss if (l == 1)
1288 1.1 augustss return (1);
1289 1.1 augustss p->bDescriptorType = UDESC_STRING;
1290 1.1 augustss l -= 2;
1291 1.1 augustss for (i = 0; s[i] && l > 1; i++, l -= 2)
1292 1.1 augustss USETW2(p->bString[i], 0, s[i]);
1293 1.1 augustss return (2*i+2);
1294 1.1 augustss }
1295 1.1 augustss
1296 1.1 augustss /*
1297 1.1 augustss * Simulate a hardware hub by handling all the necessary requests.
1298 1.1 augustss */
1299 1.1 augustss usbd_status
1300 1.1 augustss ohci_root_ctrl_transfer(reqh)
1301 1.1 augustss usbd_request_handle reqh;
1302 1.1 augustss {
1303 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)reqh->pipe->device->bus;
1304 1.1 augustss usb_device_request_t *req;
1305 1.1 augustss void *buf;
1306 1.1 augustss int port, i;
1307 1.1 augustss int len, value, index, l, totlen = 0;
1308 1.1 augustss usb_port_status_t ps;
1309 1.1 augustss usb_hub_descriptor_t hubd;
1310 1.1 augustss usbd_status r;
1311 1.1 augustss u_int32_t v;
1312 1.1 augustss
1313 1.1 augustss if (!reqh->isreq)
1314 1.1 augustss /* XXX panic */
1315 1.1 augustss return (USBD_INVAL);
1316 1.1 augustss req = &reqh->request;
1317 1.1 augustss buf = reqh->buffer;
1318 1.1 augustss
1319 1.1 augustss DPRINTFN(4,("ohci_root_ctrl_control type=0x%02x request=%02x\n",
1320 1.1 augustss req->bmRequestType, req->bRequest));
1321 1.1 augustss
1322 1.1 augustss len = UGETW(req->wLength);
1323 1.1 augustss value = UGETW(req->wValue);
1324 1.1 augustss index = UGETW(req->wIndex);
1325 1.1 augustss #define C(x,y) ((x) | ((y) << 8))
1326 1.1 augustss switch(C(req->bRequest, req->bmRequestType)) {
1327 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
1328 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
1329 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
1330 1.1 augustss /*
1331 1.1 augustss * DEVICE_REMOTE_WAKEUP and ENDPOINT_STALL are no-ops
1332 1.1 augustss * for the integrated root hub.
1333 1.1 augustss */
1334 1.1 augustss break;
1335 1.1 augustss case C(UR_GET_CONFIG, UT_READ_DEVICE):
1336 1.1 augustss if (len > 0) {
1337 1.1 augustss *(u_int8_t *)buf = sc->sc_conf;
1338 1.1 augustss totlen = 1;
1339 1.1 augustss }
1340 1.1 augustss break;
1341 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
1342 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_control wValue=0x%04x\n", value));
1343 1.1 augustss switch(value >> 8) {
1344 1.1 augustss case UDESC_DEVICE:
1345 1.1 augustss if ((value & 0xff) != 0) {
1346 1.1 augustss r = USBD_IOERROR;
1347 1.1 augustss goto ret;
1348 1.1 augustss }
1349 1.1 augustss totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
1350 1.1 augustss memcpy(buf, &ohci_devd, l);
1351 1.1 augustss break;
1352 1.1 augustss case UDESC_CONFIG:
1353 1.1 augustss if ((value & 0xff) != 0) {
1354 1.1 augustss r = USBD_IOERROR;
1355 1.1 augustss goto ret;
1356 1.1 augustss }
1357 1.1 augustss totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
1358 1.1 augustss memcpy(buf, &ohci_confd, l);
1359 1.1 augustss buf = (char *)buf + l;
1360 1.1 augustss len -= l;
1361 1.1 augustss l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
1362 1.1 augustss totlen += l;
1363 1.1 augustss memcpy(buf, &ohci_ifcd, l);
1364 1.1 augustss buf = (char *)buf + l;
1365 1.1 augustss len -= l;
1366 1.1 augustss l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
1367 1.1 augustss totlen += l;
1368 1.1 augustss memcpy(buf, &ohci_endpd, l);
1369 1.1 augustss break;
1370 1.1 augustss case UDESC_STRING:
1371 1.1 augustss if (len == 0)
1372 1.1 augustss break;
1373 1.1 augustss *(u_int8_t *)buf = 0;
1374 1.1 augustss totlen = 1;
1375 1.1 augustss switch (value & 0xff) {
1376 1.1 augustss case 1: /* Vendor */
1377 1.1 augustss totlen = ohci_str(buf, len, sc->sc_vendor);
1378 1.1 augustss break;
1379 1.1 augustss case 2: /* Product */
1380 1.1 augustss totlen = ohci_str(buf, len, "OHCI root hub");
1381 1.1 augustss break;
1382 1.1 augustss }
1383 1.1 augustss break;
1384 1.1 augustss default:
1385 1.1 augustss r = USBD_IOERROR;
1386 1.1 augustss goto ret;
1387 1.1 augustss }
1388 1.1 augustss break;
1389 1.1 augustss case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
1390 1.1 augustss if (len > 0) {
1391 1.1 augustss *(u_int8_t *)buf = 0;
1392 1.1 augustss totlen = 1;
1393 1.1 augustss }
1394 1.1 augustss break;
1395 1.1 augustss case C(UR_GET_STATUS, UT_READ_DEVICE):
1396 1.1 augustss if (len > 1) {
1397 1.1 augustss USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED);
1398 1.1 augustss totlen = 2;
1399 1.1 augustss }
1400 1.1 augustss break;
1401 1.1 augustss case C(UR_GET_STATUS, UT_READ_INTERFACE):
1402 1.1 augustss case C(UR_GET_STATUS, UT_READ_ENDPOINT):
1403 1.1 augustss if (len > 1) {
1404 1.1 augustss USETW(((usb_status_t *)buf)->wStatus, 0);
1405 1.1 augustss totlen = 2;
1406 1.1 augustss }
1407 1.1 augustss break;
1408 1.1 augustss case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
1409 1.1 augustss if (value >= USB_MAX_DEVICES) {
1410 1.1 augustss r = USBD_IOERROR;
1411 1.1 augustss goto ret;
1412 1.1 augustss }
1413 1.1 augustss sc->sc_addr = value;
1414 1.1 augustss break;
1415 1.1 augustss case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
1416 1.1 augustss if (value != 0 && value != 1) {
1417 1.1 augustss r = USBD_IOERROR;
1418 1.1 augustss goto ret;
1419 1.1 augustss }
1420 1.1 augustss sc->sc_conf = value;
1421 1.1 augustss break;
1422 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
1423 1.1 augustss break;
1424 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
1425 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
1426 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
1427 1.1 augustss r = USBD_IOERROR;
1428 1.1 augustss goto ret;
1429 1.1 augustss case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
1430 1.1 augustss break;
1431 1.1 augustss case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
1432 1.1 augustss break;
1433 1.1 augustss /* Hub requests */
1434 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
1435 1.1 augustss break;
1436 1.1 augustss case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
1437 1.1 augustss DPRINTFN(8, ("ohci_root_ctrl_control: UR_CLEAR_PORT_FEATURE port=%d feature=%d\n",
1438 1.1 augustss index, value));
1439 1.1 augustss if (index < 1 || index > sc->sc_noport) {
1440 1.1 augustss r = USBD_IOERROR;
1441 1.1 augustss goto ret;
1442 1.1 augustss }
1443 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
1444 1.1 augustss switch(value) {
1445 1.1 augustss case UHF_PORT_ENABLE:
1446 1.1 augustss OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS);
1447 1.1 augustss break;
1448 1.1 augustss case UHF_PORT_SUSPEND:
1449 1.1 augustss OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR);
1450 1.1 augustss break;
1451 1.1 augustss case UHF_PORT_POWER:
1452 1.1 augustss OWRITE4(sc, port, UPS_LOW_SPEED);
1453 1.1 augustss break;
1454 1.1 augustss case UHF_C_PORT_CONNECTION:
1455 1.1 augustss OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16);
1456 1.1 augustss break;
1457 1.1 augustss case UHF_C_PORT_ENABLE:
1458 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16);
1459 1.1 augustss break;
1460 1.1 augustss case UHF_C_PORT_SUSPEND:
1461 1.1 augustss OWRITE4(sc, port, UPS_C_SUSPEND << 16);
1462 1.1 augustss break;
1463 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
1464 1.1 augustss OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16);
1465 1.1 augustss break;
1466 1.1 augustss case UHF_C_PORT_RESET:
1467 1.1 augustss OWRITE4(sc, port, UPS_C_PORT_RESET << 16);
1468 1.1 augustss break;
1469 1.1 augustss default:
1470 1.1 augustss r = USBD_IOERROR;
1471 1.1 augustss goto ret;
1472 1.1 augustss }
1473 1.1 augustss switch(value) {
1474 1.1 augustss case UHF_C_PORT_CONNECTION:
1475 1.1 augustss case UHF_C_PORT_ENABLE:
1476 1.1 augustss case UHF_C_PORT_SUSPEND:
1477 1.1 augustss case UHF_C_PORT_OVER_CURRENT:
1478 1.1 augustss case UHF_C_PORT_RESET:
1479 1.1 augustss /* Enable RHSC interrupt if condition is cleared. */
1480 1.1 augustss if ((OREAD4(sc, port) >> 16) == 0)
1481 1.1 augustss ohci_rhsc_able(sc, 1);
1482 1.1 augustss break;
1483 1.1 augustss default:
1484 1.1 augustss break;
1485 1.1 augustss }
1486 1.1 augustss break;
1487 1.1 augustss case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
1488 1.1 augustss if (value != 0) {
1489 1.1 augustss r = USBD_IOERROR;
1490 1.1 augustss goto ret;
1491 1.1 augustss }
1492 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A);
1493 1.1 augustss hubd = ohci_hubd;
1494 1.1 augustss hubd.bNbrPorts = sc->sc_noport;
1495 1.1 augustss USETW(hubd.bHubCharacteristics,
1496 1.1 augustss (v & OHCI_NPS ? UHD_PWR_NO_SWITCH :
1497 1.1 augustss v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL)
1498 1.1 augustss /* XXX overcurrent */
1499 1.1 augustss );
1500 1.1 augustss hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v);
1501 1.1 augustss v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B);
1502 1.1 augustss if (sc->sc_noport < 8) {
1503 1.1 augustss hubd.DeviceRemovable[0] = (u_int8_t)v;
1504 1.1 augustss hubd.PortPowerCtrlMask[0] = (u_int8_t)(v >> 16);
1505 1.1 augustss hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE;
1506 1.1 augustss } else {
1507 1.1 augustss hubd.DeviceRemovable[0] = (u_int8_t)v;
1508 1.1 augustss hubd.DeviceRemovable[1] = (u_int8_t)(v>>8);
1509 1.1 augustss hubd.PortPowerCtrlMask[1] = (u_int8_t)(v >> 16);
1510 1.1 augustss hubd.PortPowerCtrlMask[2] = (u_int8_t)(v >> 24);
1511 1.1 augustss hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + 2;
1512 1.1 augustss }
1513 1.1 augustss l = min(len, hubd.bDescLength);
1514 1.1 augustss totlen = l;
1515 1.1 augustss memcpy(buf, &hubd, l);
1516 1.1 augustss break;
1517 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
1518 1.1 augustss if (len != 4) {
1519 1.1 augustss r = USBD_IOERROR;
1520 1.1 augustss goto ret;
1521 1.1 augustss }
1522 1.1 augustss memset(buf, 0, len); /* ? XXX */
1523 1.1 augustss totlen = len;
1524 1.1 augustss break;
1525 1.1 augustss case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
1526 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: get port status i=%d\n",
1527 1.1 augustss index));
1528 1.1 augustss if (index < 1 || index > sc->sc_noport) {
1529 1.1 augustss r = USBD_IOERROR;
1530 1.1 augustss goto ret;
1531 1.1 augustss }
1532 1.1 augustss if (len != 4) {
1533 1.1 augustss r = USBD_IOERROR;
1534 1.1 augustss goto ret;
1535 1.1 augustss }
1536 1.1 augustss v = OREAD4(sc, OHCI_RH_PORT_STATUS(index));
1537 1.1 augustss DPRINTFN(8,("ohci_root_ctrl_transfer: port status=0x%04x\n",
1538 1.1 augustss v));
1539 1.1 augustss USETW(ps.wPortStatus, v);
1540 1.1 augustss USETW(ps.wPortChange, v >> 16);
1541 1.1 augustss l = min(len, sizeof ps);
1542 1.1 augustss memcpy(buf, &ps, l);
1543 1.1 augustss totlen = l;
1544 1.1 augustss break;
1545 1.1 augustss case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
1546 1.1 augustss r = USBD_IOERROR;
1547 1.1 augustss goto ret;
1548 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
1549 1.1 augustss break;
1550 1.1 augustss case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
1551 1.1 augustss if (index < 1 || index > sc->sc_noport) {
1552 1.1 augustss r = USBD_IOERROR;
1553 1.1 augustss goto ret;
1554 1.1 augustss }
1555 1.1 augustss port = OHCI_RH_PORT_STATUS(index);
1556 1.1 augustss switch(value) {
1557 1.1 augustss case UHF_PORT_ENABLE:
1558 1.1 augustss OWRITE4(sc, port, UPS_PORT_ENABLED);
1559 1.1 augustss break;
1560 1.1 augustss case UHF_PORT_SUSPEND:
1561 1.1 augustss OWRITE4(sc, port, UPS_SUSPEND);
1562 1.1 augustss break;
1563 1.1 augustss case UHF_PORT_RESET:
1564 1.1 augustss DPRINTFN(5,("ohci_root_ctrl_transfer: reset port %d\n", index));
1565 1.1 augustss OWRITE4(sc, port, UPS_RESET);
1566 1.1 augustss for (i = 0; i < 10; i++) {
1567 1.6 augustss usbd_delay_ms(&sc->sc_bus, 10);
1568 1.1 augustss if ((OREAD4(sc, port) & UPS_RESET) == 0)
1569 1.1 augustss break;
1570 1.1 augustss }
1571 1.1 augustss DPRINTFN(8,("ohci port %d reset, status = 0x%04x\n",
1572 1.1 augustss index, OREAD4(sc, port)));
1573 1.1 augustss break;
1574 1.1 augustss case UHF_PORT_POWER:
1575 1.1 augustss DPRINTFN(2,("ohci_root_ctrl_transfer: set port power %d\n", index));
1576 1.1 augustss OWRITE4(sc, port, UPS_PORT_POWER);
1577 1.1 augustss break;
1578 1.1 augustss default:
1579 1.1 augustss r = USBD_IOERROR;
1580 1.1 augustss goto ret;
1581 1.1 augustss }
1582 1.1 augustss break;
1583 1.1 augustss default:
1584 1.1 augustss r = USBD_IOERROR;
1585 1.1 augustss goto ret;
1586 1.1 augustss }
1587 1.1 augustss reqh->actlen = totlen;
1588 1.1 augustss r = USBD_NORMAL_COMPLETION;
1589 1.1 augustss ret:
1590 1.1 augustss reqh->status = r;
1591 1.1 augustss reqh->xfercb(reqh);
1592 1.1 augustss return (USBD_IN_PROGRESS);
1593 1.1 augustss }
1594 1.1 augustss
1595 1.1 augustss /* Abort a root control request. */
1596 1.1 augustss void
1597 1.1 augustss ohci_root_ctrl_abort(reqh)
1598 1.1 augustss usbd_request_handle reqh;
1599 1.1 augustss {
1600 1.3 augustss /* Nothing to do, all transfers are syncronous. */
1601 1.1 augustss }
1602 1.1 augustss
1603 1.1 augustss /* Close the root pipe. */
1604 1.1 augustss void
1605 1.1 augustss ohci_root_ctrl_close(pipe)
1606 1.1 augustss usbd_pipe_handle pipe;
1607 1.1 augustss {
1608 1.1 augustss DPRINTF(("ohci_root_ctrl_close\n"));
1609 1.1 augustss }
1610 1.1 augustss
1611 1.1 augustss usbd_status
1612 1.1 augustss ohci_root_intr_transfer(reqh)
1613 1.1 augustss usbd_request_handle reqh;
1614 1.1 augustss {
1615 1.1 augustss usbd_pipe_handle pipe = reqh->pipe;
1616 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
1617 1.1 augustss struct ohci_pipe *upipe = (struct ohci_pipe *)pipe;
1618 1.4 augustss usb_dma_t *dmap;
1619 1.1 augustss usbd_status r;
1620 1.1 augustss int len;
1621 1.1 augustss
1622 1.1 augustss len = reqh->length;
1623 1.1 augustss dmap = &upipe->u.intr.datadma;
1624 1.1 augustss if (len == 0)
1625 1.1 augustss return (USBD_INVAL); /* XXX should it be? */
1626 1.1 augustss
1627 1.4 augustss r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
1628 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1629 1.1 augustss return (r);
1630 1.1 augustss sc->sc_intrreqh = reqh;
1631 1.1 augustss
1632 1.1 augustss return (USBD_IN_PROGRESS);
1633 1.1 augustss }
1634 1.1 augustss
1635 1.3 augustss /* Abort a root interrupt request. */
1636 1.1 augustss void
1637 1.1 augustss ohci_root_intr_abort(reqh)
1638 1.1 augustss usbd_request_handle reqh;
1639 1.1 augustss {
1640 1.3 augustss /* No need to abort. */
1641 1.1 augustss }
1642 1.1 augustss
1643 1.1 augustss /* Close the root pipe. */
1644 1.1 augustss void
1645 1.1 augustss ohci_root_intr_close(pipe)
1646 1.1 augustss usbd_pipe_handle pipe;
1647 1.1 augustss {
1648 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
1649 1.1 augustss sc->sc_intrreqh = 0;
1650 1.1 augustss
1651 1.1 augustss DPRINTF(("ohci_root_intr_close\n"));
1652 1.1 augustss }
1653 1.1 augustss
1654 1.1 augustss /************************/
1655 1.1 augustss
1656 1.1 augustss usbd_status
1657 1.1 augustss ohci_device_ctrl_transfer(reqh)
1658 1.1 augustss usbd_request_handle reqh;
1659 1.1 augustss {
1660 1.6 augustss ohci_softc_t *sc = (ohci_softc_t *)reqh->pipe->device->bus;
1661 1.1 augustss usbd_status r;
1662 1.1 augustss
1663 1.1 augustss if (!reqh->isreq) {
1664 1.1 augustss /* XXX panic */
1665 1.1 augustss printf("ohci_device_ctrl_transfer: not a request\n");
1666 1.1 augustss return (USBD_INVAL);
1667 1.1 augustss }
1668 1.1 augustss
1669 1.1 augustss r = ohci_device_request(reqh);
1670 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1671 1.1 augustss return (r);
1672 1.1 augustss
1673 1.6 augustss if (sc->sc_bus.use_polling)
1674 1.6 augustss ohci_waitintr(sc, reqh);
1675 1.1 augustss return (USBD_IN_PROGRESS);
1676 1.1 augustss }
1677 1.1 augustss
1678 1.1 augustss /* Abort a device control request. */
1679 1.1 augustss void
1680 1.1 augustss ohci_device_ctrl_abort(reqh)
1681 1.1 augustss usbd_request_handle reqh;
1682 1.1 augustss {
1683 1.3 augustss /* XXX inactivate */
1684 1.6 augustss usbd_delay_ms(reqh->pipe->device->bus, 1); /* make sure it is finished */
1685 1.3 augustss /* XXX call done */
1686 1.1 augustss }
1687 1.1 augustss
1688 1.1 augustss /* Close a device control pipe. */
1689 1.1 augustss void
1690 1.1 augustss ohci_device_ctrl_close(pipe)
1691 1.1 augustss usbd_pipe_handle pipe;
1692 1.1 augustss {
1693 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1694 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
1695 1.3 augustss ohci_soft_ed_t *sed = opipe->sed;
1696 1.1 augustss int s;
1697 1.1 augustss
1698 1.1 augustss s = splusb();
1699 1.1 augustss sed->ed->ed_flags |= OHCI_ED_SKIP;
1700 1.1 augustss if ((sed->ed->ed_tailp & OHCI_TAILMASK) != sed->ed->ed_headp)
1701 1.6 augustss usbd_delay_ms(&sc->sc_bus, 2);
1702 1.3 augustss ohci_rem_ed(sed, sc->sc_ctrl_head);
1703 1.3 augustss splx(s);
1704 1.3 augustss ohci_free_std(sc, opipe->tail);
1705 1.3 augustss ohci_free_sed(sc, opipe->sed);
1706 1.3 augustss /* XXX free other resources */
1707 1.3 augustss }
1708 1.3 augustss
1709 1.3 augustss /************************/
1710 1.3 augustss
1711 1.3 augustss usbd_status
1712 1.3 augustss ohci_device_bulk_transfer(reqh)
1713 1.3 augustss usbd_request_handle reqh;
1714 1.3 augustss {
1715 1.3 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
1716 1.3 augustss usbd_device_handle dev = opipe->pipe.device;
1717 1.3 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1718 1.3 augustss int addr = dev->address;
1719 1.3 augustss ohci_soft_td_t *xfer, *tail;
1720 1.3 augustss ohci_soft_ed_t *sed;
1721 1.4 augustss usb_dma_t *dmap;
1722 1.3 augustss usbd_status r;
1723 1.3 augustss int s, len, isread;
1724 1.3 augustss
1725 1.3 augustss if (reqh->isreq) {
1726 1.3 augustss /* XXX panic */
1727 1.3 augustss printf("ohci_device_bulk_transfer: a request\n");
1728 1.3 augustss return (USBD_INVAL);
1729 1.3 augustss }
1730 1.3 augustss
1731 1.3 augustss len = reqh->length;
1732 1.3 augustss dmap = &opipe->u.bulk.datadma;
1733 1.3 augustss isread = reqh->pipe->endpoint->edesc->bEndpointAddress & UE_IN;
1734 1.3 augustss sed = opipe->sed;
1735 1.3 augustss
1736 1.3 augustss opipe->u.bulk.length = len;
1737 1.3 augustss
1738 1.4 augustss r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
1739 1.3 augustss if (r != USBD_NORMAL_COMPLETION)
1740 1.3 augustss goto ret1;
1741 1.3 augustss
1742 1.3 augustss tail = ohci_alloc_std(sc);
1743 1.3 augustss if (!tail) {
1744 1.3 augustss r = USBD_NOMEM;
1745 1.3 augustss goto ret2;
1746 1.3 augustss }
1747 1.3 augustss tail->reqh = 0;
1748 1.3 augustss
1749 1.3 augustss /* Update device address */
1750 1.3 augustss sed->ed->ed_flags =
1751 1.3 augustss (sed->ed->ed_flags & ~OHCI_ED_ADDRMASK) |
1752 1.3 augustss OHCI_ED_SET_FA(addr);
1753 1.3 augustss
1754 1.3 augustss /* Set up data transaction */
1755 1.3 augustss xfer = opipe->tail;
1756 1.3 augustss xfer->td->td_flags =
1757 1.3 augustss (isread ? OHCI_TD_IN : OHCI_TD_OUT) | OHCI_TD_NOCC |
1758 1.3 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY;
1759 1.3 augustss xfer->td->td_cbp = DMAADDR(dmap);
1760 1.3 augustss xfer->nexttd = tail;
1761 1.3 augustss xfer->td->td_nexttd = tail->physaddr;
1762 1.3 augustss xfer->td->td_be = xfer->td->td_cbp + len - 1;
1763 1.3 augustss xfer->len = len;
1764 1.3 augustss xfer->reqh = reqh;
1765 1.3 augustss
1766 1.3 augustss reqh->actlen = 0;
1767 1.3 augustss reqh->hcpriv = xfer;
1768 1.3 augustss
1769 1.3 augustss if (!isread)
1770 1.3 augustss memcpy(KERNADDR(dmap), reqh->buffer, len);
1771 1.3 augustss
1772 1.3 augustss /* Insert ED in schedule */
1773 1.3 augustss s = splusb();
1774 1.3 augustss ohci_hash_add_td(sc, xfer);
1775 1.3 augustss sed->ed->ed_tailp = tail->physaddr;
1776 1.3 augustss opipe->tail = tail;
1777 1.3 augustss OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF);
1778 1.6 augustss if (reqh->timeout && !sc->sc_bus.use_polling)
1779 1.3 augustss timeout(ohci_timeout, reqh, MS_TO_TICKS(reqh->timeout));
1780 1.3 augustss splx(s);
1781 1.3 augustss
1782 1.3 augustss return (USBD_IN_PROGRESS);
1783 1.3 augustss
1784 1.3 augustss ret2:
1785 1.4 augustss usb_freemem(sc->sc_dmatag, dmap);
1786 1.3 augustss ret1:
1787 1.3 augustss return (r);
1788 1.3 augustss }
1789 1.3 augustss
1790 1.3 augustss /* Abort a device bulk request. */
1791 1.3 augustss void
1792 1.3 augustss ohci_device_bulk_abort(reqh)
1793 1.3 augustss usbd_request_handle reqh;
1794 1.3 augustss {
1795 1.3 augustss #if 0
1796 1.3 augustss sed->ed->ed_flags |= OHCI_ED_SKIP;
1797 1.3 augustss if ((sed->ed->ed_tailp & OHCI_TAILMASK) != sed->ed->ed_headp)
1798 1.6 augustss usbd_delay_ms(reqh->pipe->device->bus, 2);
1799 1.3 augustss #endif
1800 1.3 augustss /* XXX inactivate */
1801 1.6 augustss usbd_delay_ms(reqh->pipe->device->bus, 1); /* make sure it is finished */
1802 1.3 augustss /* XXX call done */
1803 1.3 augustss }
1804 1.3 augustss
1805 1.3 augustss /* Close a device bulk pipe. */
1806 1.3 augustss void
1807 1.3 augustss ohci_device_bulk_close(pipe)
1808 1.3 augustss usbd_pipe_handle pipe;
1809 1.3 augustss {
1810 1.3 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1811 1.3 augustss usbd_device_handle dev = opipe->pipe.device;
1812 1.3 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1813 1.3 augustss int s;
1814 1.3 augustss
1815 1.3 augustss s = splusb();
1816 1.3 augustss ohci_rem_ed(opipe->sed, sc->sc_bulk_head);
1817 1.1 augustss splx(s);
1818 1.1 augustss ohci_free_std(sc, opipe->tail);
1819 1.1 augustss ohci_free_sed(sc, opipe->sed);
1820 1.1 augustss /* XXX free other resources */
1821 1.1 augustss }
1822 1.1 augustss
1823 1.1 augustss /************************/
1824 1.1 augustss
1825 1.1 augustss usbd_status
1826 1.1 augustss ohci_device_intr_transfer(reqh)
1827 1.1 augustss usbd_request_handle reqh;
1828 1.1 augustss {
1829 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)reqh->pipe;
1830 1.1 augustss usbd_device_handle dev = opipe->pipe.device;
1831 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)dev->bus;
1832 1.1 augustss ohci_soft_ed_t *sed = opipe->sed;
1833 1.1 augustss ohci_soft_td_t *xfer, *tail;
1834 1.4 augustss usb_dma_t *dmap;
1835 1.1 augustss usbd_status r;
1836 1.1 augustss int len;
1837 1.1 augustss int s;
1838 1.1 augustss
1839 1.1 augustss DPRINTFN(3, ("ohci_device_intr_transfer: reqh=%p buf=%p len=%d flags=%d priv=%p\n",
1840 1.1 augustss reqh, reqh->buffer, reqh->length, reqh->flags, reqh->priv));
1841 1.1 augustss
1842 1.1 augustss if (reqh->isreq)
1843 1.1 augustss panic("ohci_device_intr_transfer: a request\n");
1844 1.1 augustss
1845 1.1 augustss len = reqh->length;
1846 1.1 augustss dmap = &opipe->u.intr.datadma;
1847 1.1 augustss if (len == 0)
1848 1.1 augustss return (USBD_INVAL); /* XXX should it be? */
1849 1.1 augustss
1850 1.1 augustss xfer = opipe->tail;
1851 1.1 augustss tail = ohci_alloc_std(sc);
1852 1.1 augustss if (!tail) {
1853 1.1 augustss r = USBD_NOMEM;
1854 1.1 augustss goto ret1;
1855 1.1 augustss }
1856 1.1 augustss tail->reqh = 0;
1857 1.1 augustss
1858 1.4 augustss r = usb_allocmem(sc->sc_dmatag, len, 0, dmap);
1859 1.1 augustss if (r != USBD_NORMAL_COMPLETION)
1860 1.1 augustss goto ret2;
1861 1.1 augustss
1862 1.1 augustss xfer->td->td_flags = OHCI_TD_IN | OHCI_TD_NOCC |
1863 1.1 augustss OHCI_TD_SET_DI(1) | OHCI_TD_TOGGLE_CARRY;
1864 1.1 augustss xfer->td->td_cbp = DMAADDR(dmap);
1865 1.1 augustss xfer->nexttd = tail;
1866 1.1 augustss xfer->td->td_nexttd = tail->physaddr;
1867 1.1 augustss xfer->td->td_be = xfer->td->td_cbp + len - 1;
1868 1.1 augustss xfer->len = len;
1869 1.1 augustss xfer->reqh = reqh;
1870 1.1 augustss
1871 1.1 augustss reqh->actlen = 0;
1872 1.1 augustss reqh->hcpriv = xfer;
1873 1.1 augustss
1874 1.1 augustss #if USB_DEBUG
1875 1.1 augustss if (ohcidebug > 5) {
1876 1.1 augustss printf("ohci_device_intr_transfer:\n");
1877 1.1 augustss ohci_dump_ed(sed);
1878 1.1 augustss ohci_dump_tds(xfer);
1879 1.1 augustss }
1880 1.1 augustss #endif
1881 1.1 augustss
1882 1.1 augustss /* Insert ED in schedule */
1883 1.1 augustss s = splusb();
1884 1.1 augustss ohci_hash_add_td(sc, xfer);
1885 1.1 augustss sed->ed->ed_tailp = tail->physaddr;
1886 1.1 augustss opipe->tail = tail;
1887 1.1 augustss #if 0
1888 1.6 augustss if (reqh->timeout && !sc->sc_bus.use_polling)
1889 1.1 augustss timeout(ohci_timeout, reqh, MS_TO_TICKS(reqh->timeout));
1890 1.1 augustss #endif
1891 1.1 augustss sed->ed->ed_flags &= ~OHCI_ED_SKIP;
1892 1.1 augustss splx(s);
1893 1.1 augustss
1894 1.1 augustss #ifdef USB_DEBUG
1895 1.1 augustss if (ohcidebug > 5) {
1896 1.1 augustss delay(5000);
1897 1.1 augustss printf("ohci_device_intr_transfer: status=%x\n",
1898 1.1 augustss OREAD4(sc, OHCI_COMMAND_STATUS));
1899 1.1 augustss ohci_dump_ed(sed);
1900 1.1 augustss ohci_dump_tds(xfer);
1901 1.1 augustss }
1902 1.1 augustss #endif
1903 1.1 augustss
1904 1.1 augustss return (USBD_IN_PROGRESS);
1905 1.1 augustss
1906 1.1 augustss ret2:
1907 1.1 augustss ohci_free_std(sc, xfer);
1908 1.1 augustss ret1:
1909 1.1 augustss return (r);
1910 1.1 augustss }
1911 1.1 augustss
1912 1.1 augustss /* Abort a device control request. */
1913 1.1 augustss void
1914 1.1 augustss ohci_device_intr_abort(reqh)
1915 1.1 augustss usbd_request_handle reqh;
1916 1.1 augustss {
1917 1.1 augustss struct uhci_pipe *opipe;
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 opipe = (struct uhci_pipe *)reqh->pipe;
1925 1.1 augustss ohci_intr_done((ohci_softc_t *)reqh->pipe->device->bus, reqh);
1926 1.1 augustss }
1927 1.1 augustss }
1928 1.1 augustss
1929 1.1 augustss /* Close a device interrupt pipe. */
1930 1.1 augustss void
1931 1.1 augustss ohci_device_intr_close(pipe)
1932 1.1 augustss usbd_pipe_handle pipe;
1933 1.1 augustss {
1934 1.1 augustss struct ohci_pipe *opipe = (struct ohci_pipe *)pipe;
1935 1.1 augustss ohci_softc_t *sc = (ohci_softc_t *)pipe->device->bus;
1936 1.1 augustss int nslots = opipe->u.intr.nslots;
1937 1.1 augustss int pos = opipe->u.intr.pos;
1938 1.1 augustss int j;
1939 1.1 augustss ohci_soft_ed_t *p, *sed = opipe->sed;
1940 1.1 augustss int s;
1941 1.1 augustss
1942 1.1 augustss DPRINTFN(1,("ohci_device_intr_close: pipe=%p nslots=%d pos=%d\n",
1943 1.1 augustss pipe, nslots, pos));
1944 1.1 augustss s = splusb();
1945 1.1 augustss sed->ed->ed_flags |= OHCI_ED_SKIP;
1946 1.1 augustss if ((sed->ed->ed_tailp & OHCI_TAILMASK) != sed->ed->ed_headp)
1947 1.6 augustss usbd_delay_ms(&sc->sc_bus, 2);
1948 1.1 augustss
1949 1.1 augustss for (p = sc->sc_eds[pos]; p && p->next != sed; p = p->next)
1950 1.1 augustss ;
1951 1.1 augustss if (!p)
1952 1.1 augustss panic("ohci_device_intr_close: ED not found\n");
1953 1.1 augustss p->next = sed->next;
1954 1.1 augustss p->ed->ed_nexted = sed->ed->ed_nexted;
1955 1.1 augustss splx(s);
1956 1.1 augustss
1957 1.1 augustss for (j = 0; j < nslots; j++)
1958 1.1 augustss --sc->sc_bws[pos * nslots + j];
1959 1.1 augustss
1960 1.1 augustss ohci_free_std(sc, opipe->tail);
1961 1.1 augustss ohci_free_sed(sc, opipe->sed);
1962 1.1 augustss /* XXX free other resources */
1963 1.1 augustss }
1964 1.1 augustss
1965 1.1 augustss usbd_status
1966 1.1 augustss ohci_device_setintr(sc, opipe, ival)
1967 1.1 augustss ohci_softc_t *sc;
1968 1.1 augustss struct ohci_pipe *opipe;
1969 1.1 augustss int ival;
1970 1.1 augustss {
1971 1.1 augustss int i, j, s, best;
1972 1.1 augustss u_int npoll, slow, shigh, nslots;
1973 1.1 augustss u_int bestbw, bw;
1974 1.1 augustss ohci_soft_ed_t *hsed, *sed = opipe->sed;
1975 1.1 augustss
1976 1.1 augustss DPRINTFN(2, ("ohci_setintr: pipe=%p\n", opipe));
1977 1.1 augustss if (ival == 0) {
1978 1.1 augustss printf("ohci_setintr: 0 interval\n");
1979 1.1 augustss return (USBD_INVAL);
1980 1.1 augustss }
1981 1.1 augustss
1982 1.1 augustss npoll = OHCI_NO_INTRS;
1983 1.1 augustss while (npoll > ival)
1984 1.1 augustss npoll /= 2;
1985 1.1 augustss DPRINTFN(2, ("ohci_setintr: ival=%d npoll=%d\n", ival, npoll));
1986 1.1 augustss
1987 1.1 augustss /*
1988 1.1 augustss * We now know which level in the tree the ED must go into.
1989 1.1 augustss * Figure out which slot has most bandwidth left over.
1990 1.1 augustss * Slots to examine:
1991 1.1 augustss * npoll
1992 1.1 augustss * 1 0
1993 1.1 augustss * 2 1 2
1994 1.1 augustss * 4 3 4 5 6
1995 1.1 augustss * 8 7 8 9 10 11 12 13 14
1996 1.1 augustss * N (N-1) .. (N-1+N-1)
1997 1.1 augustss */
1998 1.1 augustss slow = npoll-1;
1999 1.1 augustss shigh = slow + npoll;
2000 1.1 augustss nslots = OHCI_NO_INTRS / npoll;
2001 1.1 augustss for (best = i = slow, bestbw = ~0; i < shigh; i++) {
2002 1.1 augustss bw = 0;
2003 1.1 augustss for (j = 0; j < nslots; j++)
2004 1.1 augustss bw += sc->sc_bws[i * nslots + j];
2005 1.1 augustss if (bw < bestbw) {
2006 1.1 augustss best = i;
2007 1.1 augustss bestbw = bw;
2008 1.1 augustss }
2009 1.1 augustss }
2010 1.1 augustss DPRINTFN(2, ("ohci_setintr: best=%d(%d..%d) bestbw=%d\n",
2011 1.1 augustss best, slow, shigh, bestbw));
2012 1.1 augustss
2013 1.1 augustss s = splusb();
2014 1.1 augustss hsed = sc->sc_eds[best];
2015 1.1 augustss sed->next = hsed->next;
2016 1.1 augustss sed->ed->ed_nexted = hsed->ed->ed_nexted;
2017 1.1 augustss hsed->next = sed;
2018 1.1 augustss hsed->ed->ed_nexted = sed->physaddr;
2019 1.1 augustss splx(s);
2020 1.1 augustss
2021 1.1 augustss for (j = 0; j < nslots; j++)
2022 1.1 augustss ++sc->sc_bws[best * nslots + j];
2023 1.1 augustss opipe->u.intr.nslots = nslots;
2024 1.1 augustss opipe->u.intr.pos = best;
2025 1.1 augustss
2026 1.1 augustss DPRINTFN(5, ("ohci_setintr: returns %p\n", opipe));
2027 1.1 augustss return (USBD_NORMAL_COMPLETION);
2028 1.1 augustss }
2029 1.1 augustss
2030