2 * This file is part of the libpayload project.
4 * Copyright (C) 2010 Patrick Georgi
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 #include <arch/virtual.h>
34 #include "ohci_private.h"
37 static void ohci_start (hci_t *controller);
38 static void ohci_stop (hci_t *controller);
39 static void ohci_reset (hci_t *controller);
40 static void ohci_shutdown (hci_t *controller);
41 static int ohci_bulk (endpoint_t *ep, int size, u8 *data, int finalize);
42 static int ohci_control (usbdev_t *dev, direction_t dir, int drlen, void *devreq,
44 static void* ohci_create_intr_queue (endpoint_t *ep, int reqsize, int reqcount, int reqtiming);
45 static void ohci_destroy_intr_queue (endpoint_t *ep, void *queue);
46 static u8* ohci_poll_intr_queue (void *queue);
49 ohci_reset (hci_t *controller)
55 static const char *completion_codes[] = {
59 "Data toggle mismatch",
61 "Device not responding",
75 static const char *direction[] = {
84 ohci_init (pcidev_t addr)
88 hci_t *controller = new_controller ();
91 usb_fatal("Could not create USB controller instance.\n");
93 controller->instance = malloc (sizeof (ohci_t));
94 if(!controller->instance)
95 usb_fatal("Not enough memory creating USB controller instance.\n");
97 controller->start = ohci_start;
98 controller->stop = ohci_stop;
99 controller->reset = ohci_reset;
100 controller->shutdown = ohci_shutdown;
101 controller->bulk = ohci_bulk;
102 controller->control = ohci_control;
103 controller->create_intr_queue = ohci_create_intr_queue;
104 controller->destroy_intr_queue = ohci_destroy_intr_queue;
105 controller->poll_intr_queue = ohci_poll_intr_queue;
106 for (i = 0; i < 128; i++) {
107 controller->devices[i] = 0;
109 init_device_entry (controller, 0);
110 OHCI_INST (controller)->roothub = controller->devices[0];
112 controller->bus_address = addr;
113 controller->reg_base = pci_read_config32 (controller->bus_address, 0x10); // OHCI mandates MMIO, so bit 0 is clear
114 OHCI_INST (controller)->opreg = (opreg_t*)phys_to_virt(controller->reg_base);
115 printf("OHCI Version %x.%x\n", (OHCI_INST (controller)->opreg->HcRevision >> 4) & 0xf, OHCI_INST (controller)->opreg->HcRevision & 0xf);
117 if ((OHCI_INST (controller)->opreg->HcControl & HostControllerFunctionalStateMask) == USBReset) {
119 OHCI_INST (controller)->opreg->HcControl &= ~RemoteWakeupConnected;
120 OHCI_INST (controller)->opreg->HcFmInterval = (11999 * FrameInterval) | ((((11999 - 210)*6)/7) * FSLargestDataPacket);
121 /* TODO: right value for PowerOnToPowerGoodTime ? */
122 OHCI_INST (controller)->opreg->HcRhDescriptorA = NoPowerSwitching | NoOverCurrentProtection | (10 * PowerOnToPowerGoodTime);
123 OHCI_INST (controller)->opreg->HcRhDescriptorB = (0 * DeviceRemovable);
124 udelay(100); /* TODO: reset asserting according to USB spec */
125 } else if ((OHCI_INST (controller)->opreg->HcControl & HostControllerFunctionalStateMask) != USBOperational) {
126 OHCI_INST (controller)->opreg->HcControl = (OHCI_INST (controller)->opreg->HcControl & ~HostControllerFunctionalStateMask) | USBResume;
127 udelay(100); /* TODO: resume time according to USB spec */
129 int interval = OHCI_INST (controller)->opreg->HcFmInterval;
131 td_t *periodic_td = memalign(sizeof(*periodic_td), sizeof(*periodic_td));
132 memset((void*)periodic_td, 0, sizeof(*periodic_td));
133 for (i=0; i<32; i++) OHCI_INST (controller)->hcca->HccaInterruptTable[i] = virt_to_phys(periodic_td);
134 /* TODO: build HCCA data structures */
136 OHCI_INST (controller)->opreg->HcCommandStatus = HostControllerReset;
137 udelay (10); /* at most 10us for reset to complete. State must be set to Operational within 2ms (5.1.1.4) */
138 OHCI_INST (controller)->opreg->HcFmInterval = interval;
139 OHCI_INST (controller)->hcca = memalign(256, 256);
140 memset((void*)OHCI_INST (controller)->hcca, 0, 256);
142 OHCI_INST (controller)->opreg->HcHCCA = virt_to_phys(OHCI_INST (controller)->hcca);
143 OHCI_INST (controller)->opreg->HcControl &= ~IsochronousEnable; // unused by this driver
144 OHCI_INST (controller)->opreg->HcControl |= BulkListEnable; // always enabled. OHCI still sleeps on BulkListFilled
145 OHCI_INST (controller)->opreg->HcControl |= ControlListEnable; // dito
146 OHCI_INST (controller)->opreg->HcControl |= PeriodicListEnable; // FIXME: setup interrupt data structures and enable all the time
147 // disable everything, contrary to what OHCI spec says in 5.1.1.4, as we don't need IRQs
148 OHCI_INST (controller)->opreg->HcInterruptEnable = 1<<31;
149 OHCI_INST (controller)->opreg->HcInterruptDisable = ~(1<<31);
150 OHCI_INST (controller)->opreg->HcInterruptStatus = ~0;
151 OHCI_INST (controller)->opreg->HcPeriodicStart = (((OHCI_INST (controller)->opreg->HcFmInterval & FrameIntervalMask) / 10) * 9);
152 OHCI_INST (controller)->opreg->HcControl = (OHCI_INST (controller)->opreg->HcControl & ~HostControllerFunctionalStateMask) | USBOperational;
156 controller->devices[0]->controller = controller;
157 controller->devices[0]->init = ohci_rh_init;
158 controller->devices[0]->init (controller->devices[0]);
159 ohci_reset (controller);
164 ohci_shutdown (hci_t *controller)
168 detach_controller (controller);
169 ohci_stop(controller);
170 OHCI_INST (controller)->roothub->destroy (OHCI_INST (controller)->
172 free (OHCI_INST (controller));
177 ohci_start (hci_t *controller)
179 // TODO: turn on all operation of OHCI, but assume that it's initialized.
183 ohci_stop (hci_t *controller)
185 // TODO: turn off all operation of OHCI
189 dump_td(td_t *cur, int level)
192 static const char *spaces=" ";
193 const char *spc=spaces+(10-level);
195 debug("%std at %x (%s), condition code: %s\n", spc, cur, direction[cur->direction], completion_codes[cur->condition_code & 0xf]);
196 debug("%s toggle: %x\n", spc, cur->toggle);
200 wait_for_ed(usbdev_t *dev, ed_t *head)
204 /* wait for results */
205 while (((head->head_pointer & ~3) != head->tail_pointer) &&
206 !(head->head_pointer & 1) &&
207 ((((td_t*)phys_to_virt(head->head_pointer & ~3))->condition_code & 0xf)>=0xe)) {
208 debug("intst: %x; ctrl: %x; cmdst: %x; head: %x -> %x, tail: %x, condition: %x\n",
209 OHCI_INST(dev->controller)->opreg->HcInterruptStatus,
210 OHCI_INST(dev->controller)->opreg->HcControl,
211 OHCI_INST(dev->controller)->opreg->HcCommandStatus,
213 ((td_t*)phys_to_virt(head->head_pointer & ~3))->next_td,
215 ((td_t*)phys_to_virt(head->head_pointer & ~3))->condition_code);
218 if (OHCI_INST(dev->controller)->opreg->HcInterruptStatus & WritebackDoneHead) {
219 debug("done queue:\n");
220 debug("%x, %x\n", OHCI_INST(dev->controller)->hcca->HccaDoneHead, phys_to_virt(OHCI_INST(dev->controller)->hcca->HccaDoneHead));
221 if ((OHCI_INST(dev->controller)->hcca->HccaDoneHead & ~1) == 0) {
222 debug("HcInterruptStatus %x\n", OHCI_INST(dev->controller)->opreg->HcInterruptStatus);
224 td_t *done_queue = NULL;
225 td_t *done_head = (td_t*)phys_to_virt(OHCI_INST(dev->controller)->hcca->HccaDoneHead);
226 OHCI_INST(dev->controller)->opreg->HcInterruptStatus = WritebackDoneHead;
228 td_t *oldnext = (td_t*)phys_to_virt(done_head->next_td);
229 if (oldnext == done_queue) break; /* last element refers to second to last, ie. endless loop */
230 if (oldnext == phys_to_virt(0)) break; /* last element of done list == first element of real list */
231 debug("head is %x, pointing to %x. requeueing to %x\n", done_head, oldnext, done_queue);
232 done_head->next_td = (u32)done_queue;
233 done_queue = done_head;
236 for (cur = done_queue; cur != 0; cur = (td_t*)cur->next_td) {
241 if (head->head_pointer & 1) {
249 ohci_control (usbdev_t *dev, direction_t dir, int drlen, void *devreq, int dalen,
256 // pages are specified as 4K in OHCI, so don't use getpagesize()
257 int first_page = (unsigned long)data / 4096;
258 int last_page = (unsigned long)(data+dalen-1)/4096;
259 if (last_page < first_page) last_page = first_page;
260 int pages = (dalen==0)?0:(last_page - first_page + 1);
261 int td_count = (pages+1)/2;
263 td_t *tds = memalign(sizeof(td_t), (td_count+3)*sizeof(td_t));
264 memset((void*)tds, 0, (td_count+3)*sizeof(td_t));
266 for (i=0; i < td_count + 3; i++) {
267 tds[i].next_td = virt_to_phys(&tds[i+1]);
269 tds[td_count + 3].next_td = 0;
271 tds[0].direction = OHCI_SETUP;
272 tds[0].toggle_from_td = 1;
274 tds[0].error_count = 0;
275 tds[0].delay_interrupt = 7;
276 tds[0].condition_code = 0xf;
277 tds[0].current_buffer_pointer = virt_to_phys(devreq);
278 tds[0].buffer_end = virt_to_phys(devreq + drlen - 1);
284 cur->direction = (dir==IN)?OHCI_IN:OHCI_OUT;
285 cur->toggle_from_td = 0;
287 cur->error_count = 0;
288 cur->delay_interrupt = 7;
289 cur->condition_code = 0xf;
290 cur->current_buffer_pointer = virt_to_phys(data);
292 int consumed = (4096 - ((unsigned long)data % 4096));
293 if (consumed >= dalen) {
294 // end of data is within same page
295 cur->buffer_end = virt_to_phys(data + dalen - 1);
297 /* assert(pages == 0); */
302 int second_page_size = dalen;
304 second_page_size = 4096;
306 cur->buffer_end = virt_to_phys(data + second_page_size - 1);
307 dalen -= second_page_size;
308 data += second_page_size;
313 cur->direction = (dir==IN)?OHCI_OUT:OHCI_IN;
314 cur->toggle_from_td = 1;
316 cur->error_count = 0;
317 cur->delay_interrupt = 7;
318 cur->condition_code = 0xf;
319 cur->current_buffer_pointer = 0;
325 /* Data structures */
326 ed_t *head = memalign(sizeof(ed_t), sizeof(ed_t));
327 memset((void*)head, 0, sizeof(*head));
328 head->function_address = dev->address;
329 head->endpoint_number = 0;
330 head->direction = OHCI_FROM_TD;
331 head->lowspeed = dev->speed;
333 head->maximum_packet_size = dev->endpoints[0].maxpacketsize;
334 head->tail_pointer = virt_to_phys(cur);
335 head->head_pointer = virt_to_phys(tds);
339 debug("doing control transfer with %x. first_td at %x\n", head->function_address, virt_to_phys(tds));
341 /* activate schedule */
342 OHCI_INST(dev->controller)->opreg->HcControlHeadED = virt_to_phys(head);
343 OHCI_INST(dev->controller)->opreg->HcCommandStatus = ControlListFilled;
345 int failure = wait_for_ed(dev, head);
354 /* finalize == 1: if data is of packet aligned size, add a zero length packet */
356 ohci_bulk (endpoint_t *ep, int dalen, u8 *data, int finalize)
359 debug("bulk: %x bytes from %x, finalize: %x, maxpacketsize: %x\n", dalen, data, finalize, ep->maxpacketsize);
363 // pages are specified as 4K in OHCI, so don't use getpagesize()
364 int first_page = (unsigned long)data / 4096;
365 int last_page = (unsigned long)(data+dalen-1)/4096;
366 if (last_page < first_page) last_page = first_page;
367 int pages = (dalen==0)?0:(last_page - first_page + 1);
368 int td_count = (pages+1)/2;
370 if (finalize && ((dalen % ep->maxpacketsize) == 0)) {
374 td_t *tds = memalign(sizeof(td_t), (td_count+1)*sizeof(td_t));
375 memset((void*)tds, 0, (td_count+1)*sizeof(td_t));
377 for (i=0; i < td_count; i++) {
378 tds[i].next_td = virt_to_phys(&tds[i+1]);
381 for (cur = tds; cur->next_td != 0; cur++) {
382 cur->toggle_from_td = 0;
383 cur->error_count = 0;
384 cur->delay_interrupt = 7;
385 cur->condition_code = 0xf;
386 cur->direction = (ep->direction==IN)?OHCI_IN:OHCI_OUT;
387 cur->current_buffer_pointer = virt_to_phys(data);
390 /* magic TD for empty packet transfer */
391 cur->current_buffer_pointer = 0;
393 /* assert((pages == 0) && finalize); */
395 int consumed = (4096 - ((unsigned long)data % 4096));
396 if (consumed >= dalen) {
397 // end of data is within same page
398 cur->buffer_end = virt_to_phys(data + dalen - 1);
400 /* assert(pages == finalize); */
405 int second_page_size = dalen;
407 second_page_size = 4096;
409 cur->buffer_end = virt_to_phys(data + second_page_size - 1);
410 dalen -= second_page_size;
411 data += second_page_size;
415 /* Data structures */
416 ed_t *head = memalign(sizeof(ed_t), sizeof(ed_t));
417 memset((void*)head, 0, sizeof(*head));
418 head->function_address = ep->dev->address;
419 head->endpoint_number = ep->endpoint & 0xf;
420 head->direction = (ep->direction==IN)?OHCI_IN:OHCI_OUT;
421 head->lowspeed = ep->dev->speed;
423 head->maximum_packet_size = ep->maxpacketsize;
424 head->tail_pointer = virt_to_phys(cur);
425 head->head_pointer = virt_to_phys(tds);
427 head->toggle = ep->toggle;
429 debug("doing bulk transfer with %x(%x). first_td at %x, last %x\n", head->function_address, head->endpoint_number, virt_to_phys(tds), virt_to_phys(cur));
431 /* activate schedule */
432 OHCI_INST(ep->dev->controller)->opreg->HcBulkHeadED = virt_to_phys(head);
433 OHCI_INST(ep->dev->controller)->opreg->HcCommandStatus = BulkListFilled;
435 int failure = wait_for_ed(ep->dev, head);
437 ep->toggle = head->toggle;
451 /* create and hook-up an intr queue into device schedule */
453 ohci_create_intr_queue (endpoint_t *ep, int reqsize, int reqcount, int reqtiming)
458 /* remove queue from device schedule, dropping all data that came in */
460 ohci_destroy_intr_queue (endpoint_t *ep, void *q_)
464 /* read one intr-packet from queue, if available. extend the queue for new input.
465 return NULL if nothing new available.
466 Recommended use: while (data=poll_intr_queue(q)) process(data);
469 ohci_poll_intr_queue (void *q_)