ahci.c revision 1.12.6.8 1 /* $NetBSD: ahci.c,v 1.12.6.8 2014/12/03 14:18:07 skrll Exp $ */
2
3 /*-
4 * Copyright (c) 2007 Ruslan Ermilov and Vsevolod Lobko.
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or
8 * without modification, are permitted provided that the following
9 * conditions are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above
13 * copyright notice, this list of conditions and the following
14 * disclaimer in the documentation and/or other materials provided
15 * with the distribution.
16 * 3. The names of the authors may not be used to endorse or promote
17 * products derived from this software without specific prior
18 * written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY
21 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
22 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
23 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHORS
24 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
25 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
26 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
27 * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
29 * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
30 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
31 * OF SUCH DAMAGE.
32 */
33 /*
34 * Copyright (c) 2001 The NetBSD Foundation, Inc.
35 * All rights reserved.
36 *
37 * This code is derived from software contributed to The NetBSD Foundation
38 * by Tetsuya Isaki.
39 *
40 * Redistribution and use in source and binary forms, with or without
41 * modification, are permitted provided that the following conditions
42 * are met:
43 * 1. Redistributions of source code must retain the above copyright
44 * notice, this list of conditions and the following disclaimer.
45 * 2. Redistributions in binary form must reproduce the above copyright
46 * notice, this list of conditions and the following disclaimer in the
47 * documentation and/or other materials provided with the distribution.
48 *
49 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
50 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
51 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
52 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
53 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
54 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
55 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
56 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
57 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
58 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
59 * POSSIBILITY OF SUCH DAMAGE.
60 */
61
62 /*
63 * !! HIGHLY EXPERIMENTAL CODE !!
64 */
65
66 #include <sys/cdefs.h>
67 __KERNEL_RCSID(0, "$NetBSD: ahci.c,v 1.12.6.8 2014/12/03 14:18:07 skrll Exp $");
68
69 #include <sys/param.h>
70 #include <sys/systm.h>
71 #include <sys/kernel.h>
72 #include <sys/proc.h>
73 #include <sys/device.h>
74 #include <sys/kmem.h>
75
76 #include <sys/bus.h>
77 #include <machine/cpu.h>
78
79 #include <dev/usb/usb.h>
80 #include <dev/usb/usbdi.h>
81 #include <dev/usb/usbdivar.h>
82 #include <dev/usb/usb_mem.h>
83 #include <dev/usb/usbdevs.h>
84
85 #include <mips/adm5120/include/adm5120reg.h>
86 #include <mips/adm5120/include/adm5120var.h>
87 #include <mips/adm5120/include/adm5120_obiovar.h>
88
89 #include <mips/adm5120/dev/ahcireg.h>
90 #include <mips/adm5120/dev/ahcivar.h>
91
92 static usbd_status ahci_open(usbd_pipe_handle);
93 static void ahci_softintr(void *);
94 static void ahci_poll(struct usbd_bus *);
95 static void ahci_poll_hub(void *);
96 static void ahci_poll_device(void *arg);
97 static usbd_xfer_handle ahci_allocx(struct usbd_bus *);
98 static void ahci_freex(struct usbd_bus *, usbd_xfer_handle);
99
100 static void ahci_get_lock(struct usbd_bus *, kmutex_t **);
101
102 static int ahci_str(usb_string_descriptor_t *, int, const char *);
103
104 static usbd_status ahci_root_ctrl_transfer(usbd_xfer_handle);
105 static usbd_status ahci_root_ctrl_start(usbd_xfer_handle);
106 static void ahci_root_ctrl_abort(usbd_xfer_handle);
107 static void ahci_root_ctrl_close(usbd_pipe_handle);
108 static void ahci_root_ctrl_done(usbd_xfer_handle);
109
110 static usbd_status ahci_root_intr_transfer(usbd_xfer_handle);
111 static usbd_status ahci_root_intr_start(usbd_xfer_handle);
112 static void ahci_root_intr_abort(usbd_xfer_handle);
113 static void ahci_root_intr_close(usbd_pipe_handle);
114 static void ahci_root_intr_done(usbd_xfer_handle);
115
116 static usbd_status ahci_device_ctrl_transfer(usbd_xfer_handle);
117 static usbd_status ahci_device_ctrl_start(usbd_xfer_handle);
118 static void ahci_device_ctrl_abort(usbd_xfer_handle);
119 static void ahci_device_ctrl_close(usbd_pipe_handle);
120 static void ahci_device_ctrl_done(usbd_xfer_handle);
121
122 static usbd_status ahci_device_intr_transfer(usbd_xfer_handle);
123 static usbd_status ahci_device_intr_start(usbd_xfer_handle);
124 static void ahci_device_intr_abort(usbd_xfer_handle);
125 static void ahci_device_intr_close(usbd_pipe_handle);
126 static void ahci_device_intr_done(usbd_xfer_handle);
127
128 static usbd_status ahci_device_isoc_transfer(usbd_xfer_handle);
129 static usbd_status ahci_device_isoc_start(usbd_xfer_handle);
130 static void ahci_device_isoc_abort(usbd_xfer_handle);
131 static void ahci_device_isoc_close(usbd_pipe_handle);
132 static void ahci_device_isoc_done(usbd_xfer_handle);
133
134 static usbd_status ahci_device_bulk_transfer(usbd_xfer_handle);
135 static usbd_status ahci_device_bulk_start(usbd_xfer_handle);
136 static void ahci_device_bulk_abort(usbd_xfer_handle);
137 static void ahci_device_bulk_close(usbd_pipe_handle);
138 static void ahci_device_bulk_done(usbd_xfer_handle);
139
140 static int ahci_transaction(struct ahci_softc *,
141 usbd_pipe_handle, uint8_t, int, u_char *, uint8_t);
142 static void ahci_noop(usbd_pipe_handle);
143 static void ahci_abort_xfer(usbd_xfer_handle, usbd_status);
144 static void ahci_device_clear_toggle(usbd_pipe_handle);
145
146 extern int usbdebug;
147 extern int uhubdebug;
148 extern int umassdebug;
149 int ahci_dummy;
150
151 #define AHCI_DEBUG
152
153 /* For root hub */
154 #define AHCI_INTR_ENDPT (1)
155
156 #ifdef AHCI_DEBUG
157 #define D_TRACE (0x0001) /* function trace */
158 #define D_MSG (0x0002) /* debug messages */
159 #define D_XFER (0x0004) /* transfer messages (noisy!) */
160 #define D_MEM (0x0008) /* memory allocation */
161
162 int ahci_debug = 0;
163 #define DPRINTF(z,x) if((ahci_debug&(z))!=0)printf x
164 void print_req(usb_device_request_t *);
165 void print_req_hub(usb_device_request_t *);
166 void print_dumpreg(struct ahci_softc *);
167 void print_xfer(usbd_xfer_handle);
168 #else
169 #define DPRINTF(z,x)
170 #endif
171
172
173 struct usbd_bus_methods ahci_bus_methods = {
174 .ubm_open = ahci_open,
175 .ubm_softint = ahci_softintr,
176 .ubm_dopoll = ahci_poll,
177 .ubm_allocx = ahci_allocx,
178 .ubm_freex = ahci_freex,
179 .ubm_getlock = ahci_get_lock,
180 };
181
182 struct usbd_pipe_methods ahci_root_ctrl_methods = {
183 .upm_transfer = ahci_root_ctrl_transfer,
184 .upm_start = ahci_root_ctrl_start,
185 .upm_abort = ahci_root_ctrl_abort,
186 .upm_close = ahci_root_ctrl_close,
187 .upm_cleartoggle = ahci_noop,
188 .upm_done = ahci_root_ctrl_done,
189 };
190
191 struct usbd_pipe_methods ahci_root_intr_methods = {
192 .upm_transfer = ahci_root_intr_transfer,
193 .upm_start = ahci_root_intr_start,
194 .upm_abort = ahci_root_intr_abort,
195 .upm_close = ahci_root_intr_close,
196 .upm_cleartoggle = ahci_noop,
197 .upm_done = ahci_root_intr_done,
198 };
199
200 struct usbd_pipe_methods ahci_device_ctrl_methods = {
201 .upm_transfer = ahci_device_ctrl_transfer,
202 .upm_start = ahci_device_ctrl_start,
203 .upm_abort = ahci_device_ctrl_abort,
204 .upm_close = ahci_device_ctrl_close,
205 .upm_cleartoggle = ahci_noop,
206 .upm_done = ahci_device_ctrl_done,
207 };
208
209 struct usbd_pipe_methods ahci_device_intr_methods = {
210 .upm_transfer = ahci_device_intr_transfer,
211 .upm_start = ahci_device_intr_start,
212 .upm_abort = ahci_device_intr_abort,
213 .upm_close = ahci_device_intr_close,
214 .upm_cleartoggle = ahci_device_clear_toggle,
215 .upm_done = ahci_device_intr_done,
216 };
217
218 struct usbd_pipe_methods ahci_device_isoc_methods = {
219 .upm_transfer = ahci_device_isoc_transfer,
220 .upm_start = ahci_device_isoc_start,
221 .upm_abort = ahci_device_isoc_abort,
222 .upm_close = ahci_device_isoc_close,
223 .upm_cleartoggle = ahci_noop,
224 .upm_done = ahci_device_isoc_done,
225 };
226
227 struct usbd_pipe_methods ahci_device_bulk_methods = {
228 .upm_transfer = ahci_device_bulk_transfer,
229 .upm_start = ahci_device_bulk_start,
230 .upm_abort = ahci_device_bulk_abort,
231 .upm_close = ahci_device_bulk_close,
232 .upm_cleartoggle = ahci_device_clear_toggle,
233 .upm_done = ahci_device_bulk_done,
234 };
235
236 struct ahci_pipe {
237 struct usbd_pipe pipe;
238 uint32_t toggle;
239 };
240
241 static int ahci_match(device_t, cfdata_t, void *);
242 static void ahci_attach(device_t, device_t, void *);
243
244 CFATTACH_DECL_NEW(ahci, sizeof(struct ahci_softc),
245 ahci_match, ahci_attach, NULL, NULL);
246
247 static int
248 ahci_match(device_t parent, struct cfdata *cf, void *aux)
249 {
250 struct obio_attach_args *aa = aux;
251
252 if (strcmp(aa->oba_name, cf->cf_name) == 0)
253 return (1);
254
255 return (0);
256 }
257
258 #define REG_READ(o) bus_space_read_4(sc->sc_st, sc->sc_ioh, (o))
259 #define REG_WRITE(o,v) bus_space_write_4(sc->sc_st, sc->sc_ioh, (o),(v))
260
261 /*
262 * Attach SL11H/SL811HS. Return 0 if success.
263 */
264 void
265 ahci_attach(device_t parent, device_t self, void *aux)
266 {
267 struct obio_attach_args *aa = aux;
268 struct ahci_softc *sc = device_private(self);
269
270 printf("\n");
271 sc->sc_dmat = aa->oba_dt;
272 sc->sc_st = aa->oba_st;
273
274 /* Initialize sc */
275 sc->sc_bus.ub_revision = USBREV_1_1;
276 sc->sc_bus.ub_methods = &ahci_bus_methods;
277 sc->sc_bus.ub_pipesize = sizeof(struct ahci_pipe);
278 sc->sc_bus.ub_dmatag = sc->sc_dmat;
279 sc->sc_bus.ub_usedma = true;
280
281 /* Map the device. */
282 if (bus_space_map(sc->sc_st, aa->oba_addr,
283 512, 0, &sc->sc_ioh) != 0) {
284 aprint_error_dev(self, "unable to map device\n");
285 return;
286 }
287
288 /* Hook up the interrupt handler. */
289 sc->sc_ih = adm5120_intr_establish(aa->oba_irq, INTR_IRQ, ahci_intr, sc);
290
291 if (sc->sc_ih == NULL) {
292 aprint_error_dev(self,
293 "unable to register interrupt handler\n");
294 return;
295 }
296
297 SIMPLEQ_INIT(&sc->sc_free_xfers);
298
299 callout_init(&sc->sc_poll_handle, 0);
300
301 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
302 mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED /* XXXNH */);
303
304 REG_WRITE(ADMHCD_REG_INTENABLE, 0); /* disable interrupts */
305 REG_WRITE(ADMHCD_REG_CONTROL, ADMHCD_SW_RESET); /* reset */
306 delay_ms(10);
307 while (REG_READ(ADMHCD_REG_CONTROL) & ADMHCD_SW_RESET)
308 delay_ms(1);
309
310 REG_WRITE(ADMHCD_REG_CONTROL, ADMHCD_HOST_EN);
311 REG_WRITE(ADMHCD_REG_HOSTHEAD, 0x00000000);
312 REG_WRITE(ADMHCD_REG_FMINTERVAL, 0x20002edf);
313 REG_WRITE(ADMHCD_REG_LSTHRESH, 0x628);
314 REG_WRITE(ADMHCD_REG_RHDESCR, ADMHCD_NPS | ADMHCD_LPSC);
315 REG_WRITE(ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP);
316
317 REG_WRITE(ADMHCD_REG_INTENABLE, 0); /* XXX: enable interrupts */
318
319 #ifdef USB_DEBUG
320 /* usbdebug = 0x7f;
321 uhubdebug = 0x7f;
322 umassdebug = 0xffffffff; */
323 #endif
324
325 /* Attach USB devices */
326 sc->sc_child = config_found(self, &sc->sc_bus, usbctlprint);
327
328 }
329
330 int
331 ahci_intr(void *arg)
332 {
333 #if 0
334 struct ahci_softc *sc = arg;
335 uint8_t r;
336 #ifdef AHCI_DEBUG
337 char bitbuf[256];
338 #endif
339
340 r = sl11read(sc, SL11_ISR);
341
342 sl11write(sc, SL11_ISR, SL11_ISR_DATA | SL11_ISR_SOFTIMER);
343
344 if ((r & SL11_ISR_RESET)) {
345 sc->sc_flags |= AHCDF_RESET;
346 sl11write(sc, SL11_ISR, SL11_ISR_RESET);
347 }
348 if ((r & SL11_ISR_INSERT)) {
349 sc->sc_flags |= AHCDF_INSERT;
350 sl11write(sc, SL11_ISR, SL11_ISR_INSERT);
351 }
352
353 #ifdef AHCI_DEBUG
354 snprintb(bitbuf, sizeof(bitbuf),
355 ((sl11read(sc, SL11_CTRL) & SL11_CTRL_SUSPEND)
356 ? "\20\x8""D+\7RESUME\6INSERT\5SOF\4res\3""BABBLE\2USBB\1USBA"
357 : "\20\x8""D+\7RESET\6INSERT\5SOF\4res\3""BABBLE\2USBB\1USBA"),
358 r);
359
360 DPRINTF(D_XFER, ("I=%s ", bitbuf));
361 #endif /* AHCI_DEBUG */
362 #endif
363
364 return 0;
365 }
366
367 usbd_status
368 ahci_open(usbd_pipe_handle pipe)
369 {
370 usbd_device_handle dev = pipe->up_dev;
371 struct ahci_softc *sc = (struct ahci_softc *)dev->ud_bus;
372 struct ahci_pipe *apipe = (struct ahci_pipe *)pipe;
373 usb_endpoint_descriptor_t *ed = pipe->up_endpoint->ue_edesc;
374
375 DPRINTF(D_TRACE, ("ahci_open(addr=%d,ep=%d,scaddr=%d)",
376 dev->ud_addr, ed->bEndpointAddress, sc->sc_addr));
377
378 apipe->toggle=0;
379
380 if (dev->ud_addr == sc->sc_addr) {
381 switch (ed->bEndpointAddress) {
382 case USB_CONTROL_ENDPOINT:
383 pipe->up_methods = &ahci_root_ctrl_methods;
384 break;
385 case UE_DIR_IN | AHCI_INTR_ENDPT:
386 pipe->up_methods = &ahci_root_intr_methods;
387 break;
388 default:
389 printf("open:endpointErr!\n");
390 return USBD_INVAL;
391 }
392 } else {
393 switch (ed->bmAttributes & UE_XFERTYPE) {
394 case UE_CONTROL:
395 DPRINTF(D_MSG, ("control "));
396 pipe->up_methods = &ahci_device_ctrl_methods;
397 break;
398 case UE_INTERRUPT:
399 DPRINTF(D_MSG, ("interrupt "));
400 pipe->up_methods = &ahci_device_intr_methods;
401 break;
402 case UE_ISOCHRONOUS:
403 DPRINTF(D_MSG, ("isochronous "));
404 pipe->up_methods = &ahci_device_isoc_methods;
405 break;
406 case UE_BULK:
407 DPRINTF(D_MSG, ("bluk "));
408 pipe->up_methods = &ahci_device_bulk_methods;
409 break;
410 }
411 }
412 return USBD_NORMAL_COMPLETION;
413 }
414
415 void
416 ahci_softintr(void *arg)
417 {
418 DPRINTF(D_TRACE, ("%s()", __func__));
419 }
420
421 void
422 ahci_poll(struct usbd_bus *bus)
423 {
424 DPRINTF(D_TRACE, ("%s()", __func__));
425 }
426
427 /*
428 * Emulation of interrupt transfer for status change endpoint
429 * of root hub.
430 */
431 void
432 ahci_poll_hub(void *arg)
433 {
434 usbd_xfer_handle xfer = arg;
435 usbd_pipe_handle pipe = xfer->ux_pipe;
436 struct ahci_softc *sc = (struct ahci_softc *)pipe->up_dev->ud_bus;
437 u_char *p;
438 static int p0_state=0;
439 static int p1_state=0;
440
441 callout_reset(&sc->sc_poll_handle, sc->sc_interval, ahci_poll_hub, xfer);
442
443 /* USB spec 11.13.3 (p.260) */
444 p = KERNADDR(&xfer->ux_dmabuf, 0);
445 p[0] = 0;
446 if ((REG_READ(ADMHCD_REG_PORTSTATUS0) & ADMHCD_CCS) != p0_state) {
447 p[0] = 2;
448 DPRINTF(D_TRACE, ("!"));
449 p0_state=(REG_READ(ADMHCD_REG_PORTSTATUS0) & ADMHCD_CCS);
450 };
451 if ((REG_READ(ADMHCD_REG_PORTSTATUS1) & ADMHCD_CCS) != p1_state) {
452 p[0] = 2;
453 DPRINTF(D_TRACE, ("@"));
454 p1_state=(REG_READ(ADMHCD_REG_PORTSTATUS1) & ADMHCD_CCS);
455 };
456
457 /* no change, return NAK */
458 if (p[0] == 0)
459 return;
460
461 xfer->ux_actlen = 1;
462 xfer->ux_status = USBD_NORMAL_COMPLETION;
463 mutex_enter(&sc->sc_lock);
464 usb_transfer_complete(xfer);
465 mutex_exit(&sc->sc_lock);
466 }
467
468 usbd_xfer_handle
469 ahci_allocx(struct usbd_bus *bus)
470 {
471 struct ahci_softc *sc = (struct ahci_softc *)bus;
472 usbd_xfer_handle xfer;
473
474 DPRINTF(D_MEM, ("SLallocx"));
475
476 xfer = SIMPLEQ_FIRST(&sc->sc_free_xfers);
477 if (xfer) {
478 SIMPLEQ_REMOVE_HEAD(&sc->sc_free_xfers, ux_next);
479 #ifdef DIAGNOSTIC
480 if (xfer->ux_state != XFER_FREE) {
481 printf("ahci_allocx: xfer=%p not free, 0x%08x\n",
482 xfer, xfer->ux_state);
483 }
484 #endif
485 } else {
486 xfer = kmem_alloc(sizeof(*xfer), KM_SLEEP);
487 }
488
489 if (xfer) {
490 memset(xfer, 0, sizeof(*xfer));
491 #ifdef DIAGNOSTIC
492 xfer->ux_state = XFER_BUSY;
493 #endif
494 }
495
496 return xfer;
497 }
498
499 void
500 ahci_freex(struct usbd_bus *bus, usbd_xfer_handle xfer)
501 {
502 struct ahci_softc *sc = (struct ahci_softc *)bus;
503
504 DPRINTF(D_MEM, ("SLfreex"));
505
506 #ifdef DIAGNOSTIC
507 if (xfer->ux_state != XFER_BUSY) {
508 printf("ahci_freex: xfer=%p not busy, 0x%08x\n",
509 xfer, xfer->ux_state);
510 return;
511 }
512 xfer->ux_state = XFER_FREE;
513 #endif
514 SIMPLEQ_INSERT_HEAD(&sc->sc_free_xfers, xfer, ux_next);
515 }
516
517 static void
518 ahci_get_lock(struct usbd_bus *bus, kmutex_t **lock)
519 {
520 struct ahci_softc *sc = bus->ub_hcpriv;
521
522 *lock = &sc->sc_lock;
523 }
524
525 void
526 ahci_noop(usbd_pipe_handle pipe)
527 {
528 DPRINTF(D_TRACE, ("%s()", __func__));
529 }
530
531 /*
532 * Data structures and routines to emulate the root hub.
533 */
534 usb_device_descriptor_t ahci_devd = {
535 .bLength = USB_DEVICE_DESCRIPTOR_SIZE,
536 .bDescriptorType = UDESC_DEVICE,
537 .bcdUSB = {0x01, 0x01},
538 .bDeviceClass = UDCLASS_HUB,
539 .bDeviceSubClass = UDSUBCLASS_HUB,
540 .bDeviceProtocol = 0,
541 .bMaxPacketSize = 64,
542 .idVendor = {
543 USB_VENDOR_SCANLOGIC & 0xff,
544 USB_VENDOR_SCANLOGIC >> 8
545 },
546 .idProduct = {0},
547 .bcdDevice = {0},
548 .iManufacturer = 1,
549 .iProduct = 2,
550 .iSerialNumber = 0,
551 .bNumConfigurations = 1
552 };
553
554 usb_config_descriptor_t ahci_confd = {
555 .bLength = USB_CONFIG_DESCRIPTOR_SIZE,
556 .bDescriptorType = UDESC_CONFIG,
557 .wTotalLength = {
558 USB_CONFIG_DESCRIPTOR_SIZE +
559 USB_INTERFACE_DESCRIPTOR_SIZE +
560 USB_ENDPOINT_DESCRIPTOR_SIZE,
561 },
562 .bNumInterface = 1,
563 .bConfigurationValue = 1,
564 .iConfiguration = 0,
565 .bmAttributes = UC_SELF_POWERED,
566 .bMaxPower = 250
567 };
568
569 usb_interface_descriptor_t ahci_ifcd = {
570 .bLength = USB_INTERFACE_DESCRIPTOR_SIZE,
571 .bDescriptorType = UDESC_INTERFACE,
572 .bInterfaceNumber = 0,
573 .bAlternateSetting = 0,
574 .bNumEndpoints = 1,
575 .bInterfaceClass = UICLASS_HUB,
576 .bInterfaceSubClass = UISUBCLASS_HUB,
577 .bInterfaceProtocol = 0,
578 .iInterface = 0
579 };
580
581 usb_endpoint_descriptor_t ahci_endpd = {
582 .bLength = USB_ENDPOINT_DESCRIPTOR_SIZE,
583 .bDescriptorType = UDESC_ENDPOINT,
584 .bEndpointAddress = UE_DIR_IN | AHCI_INTR_ENDPT,
585 .bmAttributes = UE_INTERRUPT,
586 .wMaxPacketSize = {8},
587 .bInterval = 255
588 };
589
590 usb_hub_descriptor_t ahci_hubd = {
591 .bDescLength = USB_HUB_DESCRIPTOR_SIZE,
592 .bDescriptorType = UDESC_HUB,
593 .bNbrPorts = 2,
594 .wHubCharacteristics = { 0, 0 },
595 .bPwrOn2PwrGood = 0,
596 .bHubContrCurrent = 0,
597 .DeviceRemovable = { 0x00 },
598 .PortPowerCtrlMask = { 0x00 }
599 };
600
601 static int
602 ahci_str(usb_string_descriptor_t *p, int l, const char *s)
603 {
604 int i;
605
606 if (l == 0)
607 return 0;
608 p->bLength = 2 * strlen(s) + 2;
609 if (l == 1)
610 return 1;
611 p->bDescriptorType = UDESC_STRING;
612 l -= 2;
613 for (i = 0; s[i] && l > 1; i++, l -= 2)
614 USETW2(p->bString[i], 0, s[i]);
615 return 2 * i + 2;
616 }
617
618 usbd_status
619 ahci_root_ctrl_transfer(usbd_xfer_handle xfer)
620 {
621 struct ahci_softc *sc = (struct ahci_softc *)xfer->ux_pipe->up_dev->ud_bus;
622 usbd_status error;
623
624 DPRINTF(D_TRACE, ("SLRCtrans "));
625
626 /* Insert last in queue */
627 mutex_enter(&sc->sc_lock);
628 error = usb_insert_transfer(xfer);
629 mutex_exit(&sc->sc_lock);
630 if (error) {
631 DPRINTF(D_MSG, ("usb_insert_transfer returns err! "));
632 return error;
633 }
634
635 /*
636 * Pipe isn't running (otherwise error would be USBD_INPROG),
637 * so start it first.
638 */
639 return ahci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
640 }
641
642 usbd_status
643 ahci_root_ctrl_start(usbd_xfer_handle xfer)
644 {
645 struct ahci_softc *sc = (struct ahci_softc *)xfer->ux_pipe->up_dev->ud_bus;
646 usb_device_request_t *req;
647 int len, value, index, l, status;
648 int totlen = 0;
649 void *buf = NULL;
650 usb_port_status_t ps;
651 usbd_status error;
652
653
654 DPRINTF(D_TRACE, ("SLRCstart "));
655
656 req = &xfer->ux_request;
657
658 len = UGETW(req->wLength);
659 value = UGETW(req->wValue);
660 index = UGETW(req->wIndex);
661
662 if (len)
663 buf = KERNADDR(&xfer->ux_dmabuf, 0);
664
665 #ifdef AHCI_DEBUG
666 if ((ahci_debug & D_TRACE))
667 print_req_hub(req);
668 #endif
669
670 #define C(x,y) ((x) | ((y) << 8))
671 switch (C(req->bRequest, req->bmRequestType)) {
672 case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
673 DPRINTF(D_MSG, ("UR_CLEAR_FEATURE(DEVICE)XXX "));
674 break;
675 case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
676 DPRINTF(D_MSG, ("UR_CLEAR_FEATURE(INTERFACE)XXX "));
677 break;
678 case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
679 DPRINTF(D_MSG, ("UR_CLEAR_FEATURE(ENDPOINT)XXX "));
680 break;
681 case C(UR_GET_CONFIG, UT_READ_DEVICE):
682 DPRINTF(D_MSG, ("UR_GET_CONFIG "));
683 if (len > 0) {
684 *(uint8_t *)buf = sc->sc_conf;
685 totlen = 1;
686 }
687 break;
688 case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
689 switch (value >> 8) {
690 case UDESC_DEVICE:
691 DPRINTF(D_MSG, ("UDESC_DEVICE "));
692 if ((value & 0xff) != 0) {
693 error = USBD_IOERROR;
694 goto ret;
695 }
696 totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE);
697 memcpy(buf, &ahci_devd, l);
698 break;
699 case UDESC_CONFIG:
700 DPRINTF(D_MSG, ("UDESC_CONFIG "));
701 if ((value & 0xff) != 0) {
702 error = USBD_IOERROR;
703 goto ret;
704 }
705 totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE);
706 memcpy(buf, &ahci_confd, l);
707 buf = (char *)buf + l;
708 len -= l;
709
710 l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE);
711 totlen += l;
712 memcpy(buf, &ahci_ifcd, l);
713 buf = (char *)buf + l;
714 len -= l;
715
716 l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE);
717 totlen += l;
718 memcpy(buf, &ahci_endpd, l);
719 break;
720 case UDESC_STRING:
721 DPRINTF(D_MSG, ("UDESC_STR "));
722 if (len == 0)
723 break;
724 *(uint8_t *)buf = 0;
725 totlen = 1;
726 switch (value & 0xff) {
727 case 0:
728 break;
729 case 1: /* Vendor */
730 totlen = ahci_str(buf, len, "ADMTek");
731 break;
732 case 2: /* Product */
733 totlen = ahci_str(buf, len, "ADM5120 root hub");
734 break;
735 default:
736 printf("strerr%d ", value & 0xff);
737 break;
738 }
739 break;
740 default:
741 printf("unknownGetDescriptor=%x", value);
742 error = USBD_IOERROR;
743 break;
744 }
745 break;
746 case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
747 /* Get Interface, 9.4.4 */
748 if (len > 0) {
749 *(uint8_t *)buf = 0;
750 totlen = 1;
751 }
752 break;
753 case C(UR_GET_STATUS, UT_READ_DEVICE):
754 /* Get Status from device, 9.4.5 */
755 if (len > 1) {
756 USETW(((usb_status_t *)buf)->wStatus, UDS_SELF_POWERED);
757 totlen = 2;
758 }
759 break;
760 case C(UR_GET_STATUS, UT_READ_INTERFACE):
761 case C(UR_GET_STATUS, UT_READ_ENDPOINT):
762 /* Get Status from interface, endpoint, 9.4.5 */
763 if (len > 1) {
764 USETW(((usb_status_t *)buf)->wStatus, 0);
765 totlen = 2;
766 }
767 break;
768 case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
769 /* Set Address, 9.4.6 */
770 DPRINTF(D_MSG, ("UR_SET_ADDRESS "));
771 if (value >= USB_MAX_DEVICES) {
772 error = USBD_IOERROR;
773 goto ret;
774 }
775 sc->sc_addr = value;
776 break;
777 case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
778 /* Set Configuration, 9.4.7 */
779 DPRINTF(D_MSG, ("UR_SET_CONFIG "));
780 if (value != 0 && value != 1) {
781 error = USBD_IOERROR;
782 goto ret;
783 }
784 sc->sc_conf = value;
785 break;
786 case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
787 /* Set Descriptor, 9.4.8, not supported */
788 DPRINTF(D_MSG, ("UR_SET_DESCRIPTOR,WRITE_DEVICE not supported\n"));
789 break;
790 case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
791 case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
792 case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
793 /* Set Feature, 9.4.9, not supported */
794 DPRINTF(D_MSG, ("UR_SET_FEATURE not supported\n"));
795 error = USBD_IOERROR;
796 break;
797 case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
798 /* Set Interface, 9.4.10, not supported */
799 break;
800 case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
801 /* Synch Frame, 9.4.11, not supported */
802 break;
803
804 /*
805 * Hub specific requests
806 */
807 case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
808 /* Clear Hub Feature, 11.16.2.1, not supported */
809 DPRINTF(D_MSG, ("ClearHubFeature not supported\n"));
810 break;
811 case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
812
813 #define WPS(x) REG_WRITE(ADMHCD_REG_PORTSTATUS0+(index-1)*4, (x))
814 /* Clear Port Feature, 11.16.2.2 */
815 if (index != 1 && index != 2 ) {
816 error = USBD_IOERROR;
817 goto ret;
818 }
819 switch (value) {
820 case UHF_PORT_POWER:
821 DPRINTF(D_MSG, ("POWER_OFF "));
822 WPS(ADMHCD_LSDA);
823 break;
824 case UHF_PORT_SUSPEND:
825 DPRINTF(D_MSG, ("SUSPEND "));
826 WPS(ADMHCD_POCI);
827 break;
828 case UHF_PORT_ENABLE:
829 DPRINTF(D_MSG, ("ENABLE "));
830 WPS(ADMHCD_CCS);
831 break;
832 case UHF_C_PORT_CONNECTION:
833 WPS(ADMHCD_CSC);
834 break;
835 case UHF_C_PORT_RESET:
836 WPS(ADMHCD_PRSC);
837 break;
838 case UHF_C_PORT_SUSPEND:
839 WPS(ADMHCD_PSSC);
840 break;
841 case UHF_C_PORT_ENABLE:
842 WPS(ADMHCD_PESC);
843 break;
844 case UHF_C_PORT_OVER_CURRENT:
845 WPS(ADMHCD_OCIC);
846 break;
847 default:
848 printf("ClrPortFeatERR:value=0x%x ", value);
849 error = USBD_IOERROR;
850 break;
851 }
852 //DPRINTF(D_XFER, ("CH=%04x ", sc->sc_change));
853 #undef WPS
854 break;
855 case C(UR_GET_BUS_STATE, UT_READ_CLASS_OTHER):
856 /* Get Bus State, 11.16.2.3, not supported */
857 /* shall return a STALL... */
858 break;
859 case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
860 /* Get Hub Descriptor, 11.16.2.4 */
861 DPRINTF(D_MSG, ("UR_GET_DESCRIPTOR RCD"));
862 if ((value&0xff) != 0) {
863 error = USBD_IOERROR;
864 goto ret;
865 }
866 l = min(len, USB_HUB_DESCRIPTOR_SIZE);
867 totlen = l;
868 memcpy(buf, &ahci_hubd, l);
869 break;
870 case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
871 /* Get Hub Status, 11.16.2.5 */
872 DPRINTF(D_MSG, ("UR_GET_STATUS RCD"));
873 if (len != 4) {
874 error = USBD_IOERROR;
875 goto ret;
876 }
877 memset(buf, 0, len);
878 totlen = len;
879 break;
880 case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
881 /* Get Port Status, 11.16.2.6 */
882 if ((index != 1 && index != 2) || len != 4) {
883 printf("index=%d,len=%d ", index, len);
884 error = USBD_IOERROR;
885 goto ret;
886 }
887 status = REG_READ(ADMHCD_REG_PORTSTATUS0+(index-1)*4);
888 DPRINTF(D_MSG, ("UR_GET_STATUS RCO=%x ", status));
889
890 //DPRINTF(D_XFER, ("ST=%04x,CH=%04x ", status, sc->sc_change));
891 USETW(ps.wPortStatus, status & (UPS_CURRENT_CONNECT_STATUS|UPS_PORT_ENABLED|UPS_SUSPEND|UPS_OVERCURRENT_INDICATOR|UPS_RESET|UPS_PORT_POWER|UPS_LOW_SPEED));
892 USETW(ps.wPortChange, (status>>16) & (UPS_C_CONNECT_STATUS|UPS_C_PORT_ENABLED|UPS_C_SUSPEND|UPS_C_OVERCURRENT_INDICATOR|UPS_C_PORT_RESET));
893 l = min(len, sizeof(ps));
894 memcpy(buf, &ps, l);
895 totlen = l;
896 break;
897 case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
898 /* Set Hub Descriptor, 11.16.2.7, not supported */
899 /* STALL ? */
900 error = USBD_IOERROR;
901 break;
902 case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
903 /* Set Hub Feature, 11.16.2.8, not supported */
904 break;
905 case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
906 #define WPS(x) REG_WRITE(ADMHCD_REG_PORTSTATUS0+(index-1)*4, (x))
907 /* Set Port Feature, 11.16.2.9 */
908 if ((index != 1) && (index !=2)) {
909 printf("index=%d ", index);
910 error = USBD_IOERROR;
911 goto ret;
912 }
913 switch (value) {
914 case UHF_PORT_RESET:
915 DPRINTF(D_MSG, ("PORT_RESET "));
916 WPS(ADMHCD_PRS);
917 break;
918 case UHF_PORT_POWER:
919 DPRINTF(D_MSG, ("PORT_POWER "));
920 WPS(ADMHCD_PPS);
921 break;
922 case UHF_PORT_ENABLE:
923 DPRINTF(D_MSG, ("PORT_ENABLE "));
924 WPS(ADMHCD_PES);
925 break;
926 default:
927 printf("SetPortFeatERR=0x%x ", value);
928 error = USBD_IOERROR;
929 break;
930 }
931 #undef WPS
932 break;
933 default:
934 DPRINTF(D_MSG, ("ioerr(UR=%02x,UT=%02x) ",
935 req->bRequest, req->bmRequestType));
936 error = USBD_IOERROR;
937 goto ret;
938 }
939 xfer->ux_actlen = totlen;
940 error = USBD_NORMAL_COMPLETION;
941 ret:
942 xfer->ux_status = error;
943 mutex_enter(&sc->sc_lock);
944 usb_transfer_complete(xfer);
945 mutex_exit(&sc->sc_lock);
946 return USBD_IN_PROGRESS;
947 }
948
949 void
950 ahci_root_ctrl_abort(usbd_xfer_handle xfer)
951 {
952 DPRINTF(D_TRACE, ("SLRCabort "));
953 }
954
955 void
956 ahci_root_ctrl_close(usbd_pipe_handle pipe)
957 {
958 DPRINTF(D_TRACE, ("SLRCclose "));
959 }
960
961 void
962 ahci_root_ctrl_done(usbd_xfer_handle xfer)
963 {
964 DPRINTF(D_TRACE, ("SLRCdone\n"));
965 }
966
967 static usbd_status
968 ahci_root_intr_transfer(usbd_xfer_handle xfer)
969 {
970 struct ahci_softc *sc = (struct ahci_softc *)xfer->ux_pipe->up_dev->ud_bus;
971 usbd_status error;
972
973 DPRINTF(D_TRACE, ("SLRItransfer "));
974
975 /* Insert last in queue */
976 mutex_enter(&sc->sc_lock);
977 error = usb_insert_transfer(xfer);
978 mutex_exit(&sc->sc_lock);
979 if (error)
980 return error;
981
982 /*
983 * Pipe isn't running (otherwise error would be USBD_INPROG),
984 * start first.
985 */
986 return ahci_root_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
987 }
988
989 static usbd_status
990 ahci_root_intr_start(usbd_xfer_handle xfer)
991 {
992 usbd_pipe_handle pipe = xfer->ux_pipe;
993 struct ahci_softc *sc = (struct ahci_softc *)pipe->up_dev->ud_bus;
994
995 DPRINTF(D_TRACE, ("SLRIstart "));
996
997 sc->sc_interval = MS_TO_TICKS(xfer->ux_pipe->up_endpoint->ue_edesc->bInterval);
998 callout_reset(&sc->sc_poll_handle, sc->sc_interval, ahci_poll_hub, xfer);
999 sc->sc_intr_xfer = xfer;
1000 return USBD_IN_PROGRESS;
1001 }
1002
1003 static void
1004 ahci_root_intr_abort(usbd_xfer_handle xfer)
1005 {
1006 DPRINTF(D_TRACE, ("SLRIabort "));
1007 }
1008
1009 static void
1010 ahci_root_intr_close(usbd_pipe_handle pipe)
1011 {
1012 struct ahci_softc *sc = (struct ahci_softc *)pipe->up_dev->ud_bus;
1013
1014 DPRINTF(D_TRACE, ("SLRIclose "));
1015
1016 callout_stop(&sc->sc_poll_handle);
1017 sc->sc_intr_xfer = NULL;
1018 }
1019
1020 static void
1021 ahci_root_intr_done(usbd_xfer_handle xfer)
1022 {
1023 //DPRINTF(D_XFER, ("RIdn "));
1024 }
1025
1026 static usbd_status
1027 ahci_device_ctrl_transfer(usbd_xfer_handle xfer)
1028 {
1029 struct ahci_softc *sc = (struct ahci_softc *)xfer->ux_pipe->up_dev->ud_bus;
1030 usbd_status error;
1031
1032 DPRINTF(D_TRACE, ("C"));
1033
1034 mutex_enter(&sc->sc_lock);
1035 error = usb_insert_transfer(xfer);
1036 mutex_exit(&sc->sc_lock);
1037 if (error)
1038 return error;
1039
1040 return ahci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
1041 }
1042
1043 static usbd_status
1044 ahci_device_ctrl_start(usbd_xfer_handle xfer)
1045 {
1046 usbd_status status = USBD_NORMAL_COMPLETION;
1047 int s, err;
1048 static struct admhcd_ed ep_v __attribute__((aligned(16))), *ep;
1049 static struct admhcd_td td_v[4] __attribute__((aligned(16))), *td, *td1, *td2, *td3;
1050 static usb_dma_t reqdma;
1051 usbd_pipe_handle pipe = xfer->ux_pipe;
1052 usb_device_request_t *req = &xfer->ux_request;
1053 struct ahci_softc *sc = (struct ahci_softc *)pipe->up_dev->ud_bus;
1054 int len, isread;
1055
1056
1057 #if 0
1058 struct ahci_pipe *apipe = (struct ahci_pipe *)xfer->ux_pipe;
1059 #endif
1060 mutex_enter(&sc->sc_lock);
1061 /* printf("ctrl_start>>>\n"); */
1062
1063 #ifdef DIAGNOSTIC
1064 if (!(xfer->ux_rqflags & URQ_REQUEST)) {
1065 /* XXX panic */
1066 printf("ahci_device_ctrl_transfer: not a request\n");
1067 return (USBD_INVAL);
1068 }
1069 #endif
1070
1071 #define KSEG1ADDR(x) (0xa0000000 | (((uint32_t)x) & 0x1fffffff))
1072 DPRINTF(D_TRACE, ("st "));
1073 if (!ep) {
1074 ep = (struct admhcd_ed *)KSEG1ADDR(&ep_v);
1075 td = (struct admhcd_td *)KSEG1ADDR(&td_v[0]);
1076 td1 = (struct admhcd_td *)KSEG1ADDR(&td_v[1]);
1077 td2 = (struct admhcd_td *)KSEG1ADDR(&td_v[2]);
1078 td3 = (struct admhcd_td *)KSEG1ADDR(&td_v[3]);
1079 err = usb_allocmem(&sc->sc_bus,
1080 sizeof(usb_device_request_t),
1081 0, &reqdma);
1082 if (err)
1083 return (USBD_NOMEM);
1084
1085 /* printf("ep: %p\n",ep); */
1086 };
1087
1088 ep->control = pipe->up_dev->ud_addr | \
1089 ((pipe->up_dev->ud_speed==USB_SPEED_FULL)?ADMHCD_ED_SPEED:0) | \
1090 ((UGETW(pipe->up_endpoint->ue_edesc->wMaxPacketSize))<<ADMHCD_ED_MAXSHIFT);
1091 memcpy(KERNADDR(&reqdma, 0), req, sizeof *req);
1092 /* printf("status: %x\n",REG_READ(ADMHCD_REG_PORTSTATUS0));
1093 printf("ep_control: %x\n",ep->control);
1094 printf("speed: %x\n",pipe->up_dev->ud_speed);
1095 printf("req: %p\n",req);
1096 printf("dmabuf: %p\n",xfer->ux_dmabuf.block); */
1097
1098 isread = req->bmRequestType & UT_READ;
1099 len = UGETW(req->wLength);
1100
1101 ep->next = ep;
1102
1103 td->buffer = DMAADDR(&reqdma,0) | 0xa0000000;
1104 td->buflen=sizeof(*req);
1105 td->control=ADMHCD_TD_SETUP | ADMHCD_TD_DATA0 | ADMHCD_TD_OWN;
1106
1107 if (len) {
1108 td->next = td1;
1109
1110 td1->buffer = DMAADDR(&xfer->ux_dmabuf,0) | 0xa0000000;
1111 td1->buflen = len;
1112 td1->next = td2;
1113 td1->control= (isread?ADMHCD_TD_IN:ADMHCD_TD_OUT) | ADMHCD_TD_DATA1 | ADMHCD_TD_R | ADMHCD_TD_OWN;
1114 } else {
1115 td1->control = 0;
1116 td->next = td2;
1117 };
1118
1119 td2->buffer = 0;
1120 td2->buflen= 0;
1121 td2->next = td3;
1122 td2->control = (isread?ADMHCD_TD_OUT:ADMHCD_TD_IN) | ADMHCD_TD_DATA1 | ADMHCD_TD_OWN;
1123
1124 td3->buffer = 0;
1125 td3->buflen= 0;
1126 td3->next = 0;
1127 td3->control = 0;
1128
1129 ep->head = td;
1130 ep->tail = td3;
1131 /*
1132 printf("ep: %p\n",ep);
1133 printf("ep->next: %p\n",ep->next);
1134 printf("ep->head: %p\n",ep->head);
1135 printf("ep->tail: %p\n",ep->tail);
1136 printf("td: %p\n",td);
1137 printf("td->next: %p\n",td->next);
1138 printf("td->buffer: %x\n",td->buffer);
1139 printf("td->buflen: %x\n",td->buflen);
1140 printf("td1: %p\n",td1);
1141 printf("td1->next: %p\n",td1->next);
1142 printf("td2: %p\n",td2);
1143 printf("td2->next: %p\n",td2->next);
1144 printf("td3: %p\n",td3);
1145 printf("td3->next: %p\n",td3->next);
1146 */
1147
1148 REG_WRITE(ADMHCD_REG_HOSTHEAD, (uint32_t)ep);
1149 REG_WRITE(ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP | ADMHCD_DMA_EN);
1150 /* printf("1: %x %x %x %x\n", ep->control, td->control, td1->control, td2->control); */
1151 s=100;
1152 while (s--) {
1153 delay_ms(10);
1154 /* printf("%x %x %x %x\n", ep->control, td->control, td1->control, td2->control);*/
1155 status = USBD_TIMEOUT;
1156 if (td->control & ADMHCD_TD_OWN) continue;
1157
1158 err = (td->control & ADMHCD_TD_ERRMASK)>>ADMHCD_TD_ERRSHIFT;
1159 if (err) {
1160 status = USBD_IOERROR;
1161 break;
1162 };
1163
1164 status = USBD_TIMEOUT;
1165 if (td1->control & ADMHCD_TD_OWN) continue;
1166 err = (td1->control & ADMHCD_TD_ERRMASK)>>ADMHCD_TD_ERRSHIFT;
1167 if (err) {
1168 status = USBD_IOERROR;
1169 break;
1170 };
1171
1172 status = USBD_TIMEOUT;
1173 if (td2->control & ADMHCD_TD_OWN) continue;
1174 err = (td2->control & ADMHCD_TD_ERRMASK)>>ADMHCD_TD_ERRSHIFT;
1175 if (err) {
1176 status = USBD_IOERROR;
1177 };
1178 status = USBD_NORMAL_COMPLETION;
1179 break;
1180
1181 };
1182 REG_WRITE(ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP);
1183
1184 xfer->ux_actlen = len;
1185 xfer->ux_status = status;
1186
1187 /* printf("ctrl_start<<<\n"); */
1188
1189 usb_transfer_complete(xfer);
1190 mutex_exit(&sc->sc_lock);
1191 return USBD_NORMAL_COMPLETION;
1192 }
1193
1194 static void
1195 ahci_device_ctrl_abort(usbd_xfer_handle xfer)
1196 {
1197 DPRINTF(D_TRACE, ("Cab "));
1198 ahci_abort_xfer(xfer, USBD_CANCELLED);
1199 }
1200
1201 static void
1202 ahci_device_ctrl_close(usbd_pipe_handle pipe)
1203 {
1204 DPRINTF(D_TRACE, ("Ccl "));
1205 }
1206
1207 static void
1208 ahci_device_ctrl_done(usbd_xfer_handle xfer)
1209 {
1210 DPRINTF(D_TRACE, ("Cdn "));
1211 }
1212
1213 static usbd_status
1214 ahci_device_intr_transfer(usbd_xfer_handle xfer)
1215 {
1216 struct ahci_softc *sc = (struct ahci_softc *)xfer->ux_pipe->up_dev->ud_bus;
1217 usbd_status error;
1218
1219 DPRINTF(D_TRACE, ("INTRtrans "));
1220
1221 mutex_enter(&sc->sc_lock);
1222 error = usb_insert_transfer(xfer);
1223 mutex_exit(&sc->sc_lock);
1224 if (error)
1225 return error;
1226
1227 return ahci_device_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
1228 }
1229
1230 static usbd_status
1231 ahci_device_intr_start(usbd_xfer_handle xfer)
1232 {
1233 usbd_pipe_handle pipe = xfer->ux_pipe;
1234 struct ahci_xfer *sx;
1235
1236 DPRINTF(D_TRACE, ("INTRstart "));
1237
1238 sx = kmem_intr_alloc(sizeof(*sx), KM_NOSLEEP);
1239 if (sx == NULL)
1240 goto reterr;
1241 memset(sx, 0, sizeof(*sx));
1242 sx->sx_xfer = xfer;
1243 xfer->ux_hcpriv = sx;
1244
1245 /* initialize callout */
1246 callout_init(&sx->sx_callout_t, 0);
1247 callout_reset(&sx->sx_callout_t,
1248 MS_TO_TICKS(pipe->up_endpoint->ue_edesc->bInterval),
1249 ahci_poll_device, sx);
1250
1251 /* ACK */
1252 return USBD_IN_PROGRESS;
1253
1254 reterr:
1255 return USBD_IOERROR;
1256 }
1257
1258 static void
1259 ahci_poll_device(void *arg)
1260 {
1261 struct ahci_xfer *sx = (struct ahci_xfer *)arg;
1262 usbd_xfer_handle xfer = sx->sx_xfer;
1263 usbd_pipe_handle pipe = xfer->ux_pipe;
1264 struct ahci_softc *sc = (struct ahci_softc *)pipe->up_dev->ud_bus;
1265 void *buf;
1266 int pid;
1267 int r;
1268
1269 DPRINTF(D_TRACE, ("pldev"));
1270
1271 callout_reset(&sx->sx_callout_t,
1272 MS_TO_TICKS(pipe->up_endpoint->ue_edesc->bInterval),
1273 ahci_poll_device, sx);
1274
1275 /* interrupt transfer */
1276 pid = (UE_GET_DIR(pipe->up_endpoint->ue_edesc->bEndpointAddress) == UE_DIR_IN)
1277 ? ADMHCD_TD_IN : ADMHCD_TD_OUT;
1278 buf = KERNADDR(&xfer->ux_dmabuf, 0);
1279
1280 r = ahci_transaction(sc, pipe, pid, xfer->ux_length, buf, 0/*toggle*/);
1281 if (r < 0) {
1282 DPRINTF(D_MSG, ("%s error", __func__));
1283 return;
1284 }
1285 /* no change, return NAK */
1286 if (r == 0)
1287 return;
1288
1289 xfer->ux_status = USBD_NORMAL_COMPLETION;
1290 mutex_enter(&sc->sc_lock);
1291 usb_transfer_complete(xfer);
1292 mutex_exit(&sc->sc_lock);
1293 }
1294
1295 static void
1296 ahci_device_intr_abort(usbd_xfer_handle xfer)
1297 {
1298 struct ahci_xfer *sx;
1299
1300 DPRINTF(D_TRACE, ("INTRabort "));
1301
1302 sx = xfer->ux_hcpriv;
1303 if (sx) {
1304 callout_stop(&sx->sx_callout_t);
1305 kmem_intr_free(sx, sizeof(*sx));
1306 xfer->ux_hcpriv = NULL;
1307 } else {
1308 printf("%s: sx == NULL!\n", __func__);
1309 }
1310 ahci_abort_xfer(xfer, USBD_CANCELLED);
1311 }
1312
1313 static void
1314 ahci_device_intr_close(usbd_pipe_handle pipe)
1315 {
1316 DPRINTF(D_TRACE, ("INTRclose "));
1317 }
1318
1319 static void
1320 ahci_device_intr_done(usbd_xfer_handle xfer)
1321 {
1322 DPRINTF(D_TRACE, ("INTRdone "));
1323 }
1324
1325 static usbd_status
1326 ahci_device_isoc_transfer(usbd_xfer_handle xfer)
1327 {
1328 DPRINTF(D_TRACE, ("S"));
1329 return USBD_NORMAL_COMPLETION;
1330 }
1331
1332 static usbd_status
1333 ahci_device_isoc_start(usbd_xfer_handle xfer)
1334 {
1335 DPRINTF(D_TRACE, ("st "));
1336 return USBD_NORMAL_COMPLETION;
1337 }
1338
1339 static void
1340 ahci_device_isoc_abort(usbd_xfer_handle xfer)
1341 {
1342 DPRINTF(D_TRACE, ("Sab "));
1343 }
1344
1345 static void
1346 ahci_device_isoc_close(usbd_pipe_handle pipe)
1347 {
1348 DPRINTF(D_TRACE, ("Scl "));
1349 }
1350
1351 static void
1352 ahci_device_isoc_done(usbd_xfer_handle xfer)
1353 {
1354 DPRINTF(D_TRACE, ("Sdn "));
1355 }
1356
1357 static usbd_status
1358 ahci_device_bulk_transfer(usbd_xfer_handle xfer)
1359 {
1360 struct ahci_softc *sc = (struct ahci_softc *)xfer->ux_pipe->up_dev->ud_bus;
1361 usbd_status error;
1362
1363 DPRINTF(D_TRACE, ("B"));
1364
1365 mutex_enter(&sc->sc_lock);
1366 error = usb_insert_transfer(xfer);
1367 mutex_exit(&sc->sc_lock);
1368 if (error)
1369 return error;
1370
1371 return ahci_device_bulk_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
1372 }
1373
1374 static usbd_status
1375 ahci_device_bulk_start(usbd_xfer_handle xfer)
1376 {
1377 #define NBULK_TDS 32
1378 static volatile int level = 0;
1379 usbd_status status = USBD_NORMAL_COMPLETION;
1380 int s, err;
1381 static struct admhcd_ed ep_v __attribute__((aligned(16))), *ep;
1382 static struct admhcd_td td_v[NBULK_TDS] __attribute__((aligned(16))), *td[NBULK_TDS];
1383 usbd_pipe_handle pipe = xfer->ux_pipe;
1384 struct ahci_softc *sc = (struct ahci_softc *)pipe->up_dev->ud_bus;
1385 int endpt, i, len, tlen, segs, offset, isread, toggle, short_ok;
1386 struct ahci_pipe *apipe = (struct ahci_pipe *)xfer->ux_pipe;
1387
1388 #define KSEG1ADDR(x) (0xa0000000 | (((uint32_t)x) & 0x1fffffff))
1389 DPRINTF(D_TRACE, ("st "));
1390
1391 #ifdef DIAGNOSTIC
1392 if (xfer->ux_rqflags & URQ_REQUEST) {
1393 /* XXX panic */
1394 printf("ohci_device_bulk_start: a request\n");
1395 return (USBD_INVAL);
1396 }
1397 #endif
1398
1399 mutex_enter(&sc->sc_lock);
1400 level++;
1401 /* printf("bulk_start>>>\n"); */
1402
1403 if (!ep) {
1404 ep = (struct admhcd_ed *)KSEG1ADDR(&ep_v);
1405 for (i=0; i<NBULK_TDS; i++) {
1406 td[i] = (struct admhcd_td *)KSEG1ADDR(&td_v[i]);
1407 };
1408 /* printf("ep: %p\n",ep);*/
1409 };
1410 if (apipe->toggle == 0) {
1411 toggle = ADMHCD_TD_DATA0;
1412 } else {
1413 toggle = apipe->toggle;
1414 };
1415
1416 endpt = pipe->up_endpoint->ue_edesc->bEndpointAddress;
1417 ep->control = pipe->up_dev->ud_addr | ((endpt & 0xf) << ADMHCD_ED_EPSHIFT)|\
1418 ((pipe->up_dev->ud_speed==USB_SPEED_FULL)?ADMHCD_ED_SPEED:0) | \
1419 ((UGETW(pipe->up_endpoint->ue_edesc->wMaxPacketSize))<<ADMHCD_ED_MAXSHIFT);
1420
1421 short_ok = xfer->ux_flags & USBD_SHORT_XFER_OK?ADMHCD_TD_R:0;
1422 /* printf("level: %d\n",level);
1423 printf("short_xfer: %x\n",short_ok);
1424 printf("ep_control: %x\n",ep->control);
1425 printf("speed: %x\n",pipe->up_dev->ud_speed);
1426 printf("dmabuf: %p\n",xfer->ux_dmabuf.block); */
1427
1428 isread = UE_GET_DIR(endpt) == UE_DIR_IN;
1429 len = xfer->ux_length;
1430
1431 ep->next = ep;
1432
1433 i = 0;
1434 offset = 0;
1435 while ((len>0) || (i==0)) {
1436 tlen = min(len,4096);
1437 td[i]->buffer = DMAADDR(&xfer->ux_dmabuf,offset) | 0xa0000000;
1438 td[i]->buflen=tlen;
1439 td[i]->control=(isread?ADMHCD_TD_IN:ADMHCD_TD_OUT) | toggle | ADMHCD_TD_OWN | short_ok;
1440 td[i]->len=tlen;
1441 toggle = ADMHCD_TD_TOGGLE;
1442 len -= tlen;
1443 offset += tlen;
1444 td[i]->next = td[i+1];
1445 i++;
1446 };
1447
1448 td[i]->buffer = 0;
1449 td[i]->buflen = 0;
1450 td[i]->control = 0;
1451 td[i]->next = 0;
1452
1453 ep->head = td[0];
1454 ep->tail = td[i];
1455 segs = i;
1456 len = 0;
1457
1458 /* printf("segs: %d\n",segs);
1459 printf("ep: %p\n",ep);
1460 printf("ep->control: %x\n",ep->control);
1461 printf("ep->next: %p\n",ep->next);
1462 printf("ep->head: %p\n",ep->head);
1463 printf("ep->tail: %p\n",ep->tail);
1464 for (i=0; i<segs; i++) {
1465 printf("td[%d]: %p\n",i,td[i]);
1466 printf("td[%d]->control: %x\n",i,td[i]->control);
1467 printf("td[%d]->next: %p\n",i,td[i]->next);
1468 printf("td[%d]->buffer: %x\n",i,td[i]->buffer);
1469 printf("td[%d]->buflen: %x\n",i,td[i]->buflen);
1470 }; */
1471
1472 REG_WRITE(ADMHCD_REG_HOSTHEAD, (uint32_t)ep);
1473 REG_WRITE(ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP | ADMHCD_DMA_EN);
1474 i = 0;
1475 /* printf("1: %x %d %x %x\n", ep->control, i, td[i]->control, td[i]->buflen); */
1476 s=100;
1477 err = 0;
1478 while (s--) {
1479 /* printf("%x %d %x %x\n", ep->control, i, td[i]->control, td[i]->buflen); */
1480 status = USBD_TIMEOUT;
1481 if (td[i]->control & ADMHCD_TD_OWN) {
1482 delay_ms(3);
1483 continue;
1484 };
1485
1486 len += td[i]->len - td[i]->buflen;
1487
1488 err = (td[i]->control & ADMHCD_TD_ERRMASK)>>ADMHCD_TD_ERRSHIFT;
1489 if (err) {
1490 status = USBD_IOERROR;
1491 break;
1492 };
1493
1494 i++;
1495 if (i==segs) {
1496 status = USBD_NORMAL_COMPLETION;
1497 break;
1498 };
1499
1500 };
1501 REG_WRITE(ADMHCD_REG_HOSTCONTROL, ADMHCD_STATE_OP);
1502
1503 apipe->toggle = ((uint32_t)ep->head & 2)?ADMHCD_TD_DATA1:ADMHCD_TD_DATA0;
1504 /* printf("bulk_transfer_done: status: %x, err: %x, len: %x, toggle: %x\n", status,err,len,apipe->toggle); */
1505
1506 if (short_ok && (err == 0x9 || err == 0xd)) {
1507 /* printf("bulk_transfer_done: short_transfer fix\n"); */
1508 status = USBD_NORMAL_COMPLETION;
1509 };
1510 xfer->ux_actlen = len;
1511 xfer->ux_status = status;
1512
1513 level--;
1514 /* printf("bulk_start<<<\n"); */
1515
1516 usb_transfer_complete(xfer);
1517 mutex_exit(&sc->sc_lock);
1518
1519 return USBD_NORMAL_COMPLETION;
1520 }
1521
1522 static void
1523 ahci_device_bulk_abort(usbd_xfer_handle xfer)
1524 {
1525 DPRINTF(D_TRACE, ("Bab "));
1526 ahci_abort_xfer(xfer, USBD_CANCELLED);
1527 }
1528
1529 static void
1530 ahci_device_bulk_close(usbd_pipe_handle pipe)
1531 {
1532 DPRINTF(D_TRACE, ("Bcl "));
1533 }
1534
1535 static void
1536 ahci_device_bulk_done(usbd_xfer_handle xfer)
1537 {
1538 DPRINTF(D_TRACE, ("Bdn "));
1539 }
1540
1541 #define DATA0_RD (0x03)
1542 #define DATA0_WR (0x07)
1543 #define AHCI_TIMEOUT (5000)
1544
1545 /*
1546 * Do a transaction.
1547 * return 1 if ACK, 0 if NAK, -1 if error.
1548 */
1549 static int
1550 ahci_transaction(struct ahci_softc *sc, usbd_pipe_handle pipe,
1551 uint8_t pid, int len, u_char *buf, uint8_t toggle)
1552 {
1553 return -1;
1554 #if 0
1555 #ifdef AHCI_DEBUG
1556 char str[64];
1557 int i;
1558 #endif
1559 int timeout;
1560 int ls_via_hub = 0;
1561 int pl;
1562 uint8_t isr;
1563 uint8_t result = 0;
1564 uint8_t devaddr = pipe->up_dev->ud_addr;
1565 uint8_t endpointaddr = pipe->up_endpoint->ue_edesc->bEndpointAddress;
1566 uint8_t endpoint;
1567 uint8_t cmd = DATA0_RD;
1568
1569 endpoint = UE_GET_ADDR(endpointaddr);
1570 DPRINTF(D_XFER, ("\n(%x,%d%s%d,%d) ",
1571 pid, len, (pid == SL11_PID_IN) ? "<-" : "->", devaddr, endpoint));
1572
1573 /* Set registers */
1574 sl11write(sc, SL11_E0ADDR, 0x40);
1575 sl11write(sc, SL11_E0LEN, len);
1576 sl11write(sc, SL11_E0PID, (pid << 4) + endpoint);
1577 sl11write(sc, SL11_E0DEV, devaddr);
1578
1579 /* Set buffer unless PID_IN */
1580 if (pid != SL11_PID_IN) {
1581 if (len > 0)
1582 sl11write_region(sc, 0x40, buf, len);
1583 cmd = DATA0_WR;
1584 }
1585
1586 /* timing ? */
1587 pl = (len >> 3) + 3;
1588
1589 /* Low speed device via HUB */
1590 /* XXX does not work... */
1591 if ((sc->sc_fullspeed) && pipe->up_dev->ud_speed == USB_SPEED_LOW) {
1592 pl = len + 16;
1593 cmd |= SL11_EPCTRL_PREAMBLE;
1594
1595 /*
1596 * SL811HS/T rev 1.2 has a bug, when it got PID_IN
1597 * from LowSpeed device via HUB.
1598 */
1599 if (sc->sc_sltype == SLTYPE_SL811HS_R12 && pid == SL11_PID_IN) {
1600 ls_via_hub = 1;
1601 DPRINTF(D_MSG, ("LSvH "));
1602 }
1603 }
1604
1605 /* timing ? */
1606 if (sl11read(sc, SL811_CSOF) <= (uint8_t)pl)
1607 cmd |= SL11_EPCTRL_SOF;
1608
1609 /* Transfer */
1610 sl11write(sc, SL11_ISR, 0xff);
1611 sl11write(sc, SL11_E0CTRL, cmd | toggle);
1612
1613 /* Polling */
1614 for (timeout = AHCI_TIMEOUT; timeout; timeout--) {
1615 isr = sl11read(sc, SL11_ISR);
1616 if ((isr & SL11_ISR_USBA))
1617 break;
1618 }
1619
1620 /* Check result status */
1621 result = sl11read(sc, SL11_E0STAT);
1622 if (!(result & SL11_EPSTAT_NAK) && ls_via_hub) {
1623 /* Resend PID_IN within 20usec */
1624 sl11write(sc, SL11_ISR, 0xff);
1625 sl11write(sc, SL11_E0CTRL, SL11_EPCTRL_ARM);
1626 }
1627
1628 sl11write(sc, SL11_ISR, 0xff);
1629
1630 DPRINTF(D_XFER, ("t=%d i=%x ", AHCI_TIMEOUT - timeout, isr));
1631 #if AHCI_DEBUG
1632 snprintb(str, sizeof(str),
1633 "\20\x8STALL\7NAK\6OV\5SETUP\4DATA1\3TIMEOUT\2ERR\1ACK", result);
1634 DPRINTF(D_XFER, ("STAT=%s ", str));
1635 #endif
1636
1637 if ((result & SL11_EPSTAT_ERROR))
1638 return -1;
1639
1640 if ((result & SL11_EPSTAT_NAK))
1641 return 0;
1642
1643 /* Read buffer if PID_IN */
1644 if (pid == SL11_PID_IN && len > 0) {
1645 sl11read_region(sc, buf, 0x40, len);
1646 #if AHCI_DEBUG
1647 for (i = 0; i < len; i++)
1648 DPRINTF(D_XFER, ("%02X ", buf[i]));
1649 #endif
1650 }
1651
1652 return 1;
1653 #endif
1654 }
1655
1656 void
1657 ahci_abort_xfer(usbd_xfer_handle xfer, usbd_status status)
1658 {
1659 xfer->ux_status = status;
1660 usb_transfer_complete(xfer);
1661 }
1662
1663 void
1664 ahci_device_clear_toggle(usbd_pipe_handle pipe)
1665 {
1666 struct ahci_pipe *apipe = (struct ahci_pipe *)pipe;
1667 apipe->toggle = 0;
1668 }
1669
1670 #ifdef AHCI_DEBUG
1671 void
1672 print_req(usb_device_request_t *r)
1673 {
1674 const char *xmes[]={
1675 "GETSTAT",
1676 "CLRFEAT",
1677 "res",
1678 "SETFEAT",
1679 "res",
1680 "SETADDR",
1681 "GETDESC",
1682 "SETDESC",
1683 "GETCONF",
1684 "SETCONF",
1685 "GETIN/F",
1686 "SETIN/F",
1687 "SYNC_FR"
1688 };
1689 int req, type, value, index, len;
1690
1691 req = r->bRequest;
1692 type = r->bmRequestType;
1693 value = UGETW(r->wValue);
1694 index = UGETW(r->wIndex);
1695 len = UGETW(r->wLength);
1696
1697 printf("%x,%s,v=%d,i=%d,l=%d ",
1698 type, xmes[req], value, index, len);
1699 }
1700
1701 void
1702 print_req_hub(usb_device_request_t *r)
1703 {
1704 struct {
1705 int req;
1706 int type;
1707 const char *str;
1708 } conf[] = {
1709 { 1, 0x20, "ClrHubFeat" },
1710 { 1, 0x23, "ClrPortFeat" },
1711 { 2, 0xa3, "GetBusState" },
1712 { 6, 0xa0, "GetHubDesc" },
1713 { 0, 0xa0, "GetHubStat" },
1714 { 0, 0xa3, "GetPortStat" },
1715 { 7, 0x20, "SetHubDesc" },
1716 { 3, 0x20, "SetHubFeat" },
1717 { 3, 0x23, "SetPortFeat" },
1718 {-1, 0, NULL},
1719 };
1720 int i;
1721 int value, index, len;
1722
1723 value = UGETW(r->wValue);
1724 index = UGETW(r->wIndex);
1725 len = UGETW(r->wLength);
1726 for (i = 0; ; i++) {
1727 if (conf[i].req == -1 )
1728 return print_req(r);
1729 if (r->bmRequestType == conf[i].type && r->bRequest == conf[i].req) {
1730 printf("%s", conf[i].str);
1731 break;
1732 }
1733 }
1734 printf(",v=%d,i=%d,l=%d ", value, index, len);
1735 }
1736
1737 void
1738 print_dumpreg(struct ahci_softc *sc)
1739 {
1740 #if 0
1741 printf("00=%02x,01=%02x,02=%02x,03=%02x,04=%02x,"
1742 "08=%02x,09=%02x,0A=%02x,0B=%02x,0C=%02x,",
1743 sl11read(sc, 0), sl11read(sc, 1),
1744 sl11read(sc, 2), sl11read(sc, 3),
1745 sl11read(sc, 4), sl11read(sc, 8),
1746 sl11read(sc, 9), sl11read(sc, 10),
1747 sl11read(sc, 11), sl11read(sc, 12)
1748 );
1749 printf("CR1=%02x,IER=%02x,0D=%02x,0E=%02x,0F=%02x ",
1750 sl11read(sc, 5), sl11read(sc, 6),
1751 sl11read(sc, 13), sl11read(sc, 14), sl11read(sc, 15)
1752 );
1753 #endif
1754 }
1755
1756 void
1757 print_xfer(usbd_xfer_handle xfer)
1758 {
1759 printf("xfer: length=%d, actlen=%d, flags=%x, timeout=%d,",
1760 xfer->ux_length, xfer->ux_actlen, xfer->ux_flags, xfer->ux_timeout);
1761 printf("request{ ");
1762 print_req_hub(&xfer->ux_request);
1763 printf("} ");
1764 }
1765 #endif /* AHCI_DEBUG */
1766