Wesley Schon / Mbed 2 deprecated ECE4180Lab3_RTOS

Running multiple threads on mbed using RTOS

Dependencies:   4DGL-uLCD-SE SDFileSystem mbed-rtos mbed wave_player_appbd

USBHostMSD/USBHost/USBHost.cpp@1:2129bb91c172, 2016-02-28 (annotated)

Committer:
wschon
Date:
Sun Feb 28 22:40:13 2016 +0000
Revision:
1:2129bb91c172
Added USB libraries;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
wschon 1:2129bb91c172 1 /* mbed USBHost Library
wschon 1:2129bb91c172 2 * Copyright (c) 2006-2013 ARM Limited
wschon 1:2129bb91c172 3 *
wschon 1:2129bb91c172 4 * Licensed under the Apache License, Version 2.0 (the "License");
wschon 1:2129bb91c172 5 * you may not use this file except in compliance with the License.
wschon 1:2129bb91c172 6 * You may obtain a copy of the License at
wschon 1:2129bb91c172 7 *
wschon 1:2129bb91c172 8 * http://www.apache.org/licenses/LICENSE-2.0
wschon 1:2129bb91c172 9 *
wschon 1:2129bb91c172 10 * Unless required by applicable law or agreed to in writing, software
wschon 1:2129bb91c172 11 * distributed under the License is distributed on an "AS IS" BASIS,
wschon 1:2129bb91c172 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
wschon 1:2129bb91c172 13 * See the License for the specific language governing permissions and
wschon 1:2129bb91c172 14 * limitations under the License.
wschon 1:2129bb91c172 15 */
wschon 1:2129bb91c172 16
wschon 1:2129bb91c172 17
wschon 1:2129bb91c172 18 #include "USBHost.h"
wschon 1:2129bb91c172 19 #include "USBHostHub.h"
wschon 1:2129bb91c172 20
wschon 1:2129bb91c172 21 USBHost * USBHost::instHost = NULL;
wschon 1:2129bb91c172 22
wschon 1:2129bb91c172 23 #define DEVICE_CONNECTED_EVENT (1 << 0)
wschon 1:2129bb91c172 24 #define DEVICE_DISCONNECTED_EVENT (1 << 1)
wschon 1:2129bb91c172 25 #define TD_PROCESSED_EVENT (1 << 2)
wschon 1:2129bb91c172 26
wschon 1:2129bb91c172 27 #define MAX_TRY_ENUMERATE_HUB 3
wschon 1:2129bb91c172 28
wschon 1:2129bb91c172 29 #define MIN(a, b) ((a > b) ? b : a)
wschon 1:2129bb91c172 30
wschon 1:2129bb91c172 31 DigitalOut l4(LED4);
wschon 1:2129bb91c172 32
wschon 1:2129bb91c172 33 /**
wschon 1:2129bb91c172 34 * How interrupts are processed:
wschon 1:2129bb91c172 35 * - new device connected:
wschon 1:2129bb91c172 36 * - a message is queued in queue_usb_event with the id DEVICE_CONNECTED_EVENT
wschon 1:2129bb91c172 37 * - when the usb_thread receives the event, it:
wschon 1:2129bb91c172 38 * - resets the device
wschon 1:2129bb91c172 39 * - reads the device descriptor
wschon 1:2129bb91c172 40 * - sets the address of the device
wschon 1:2129bb91c172 41 * - if it is a hub, enumerates it
wschon 1:2129bb91c172 42 * - device disconnected:
wschon 1:2129bb91c172 43 * - a message is queued in queue_usb_event with the id DEVICE_DISCONNECTED_EVENT
wschon 1:2129bb91c172 44 * - when the usb_thread receives the event, it:
wschon 1:2129bb91c172 45 * - free the device and all its children (hub)
wschon 1:2129bb91c172 46 * - td processed
wschon 1:2129bb91c172 47 * - a message is queued in queue_usb_event with the id TD_PROCESSED_EVENT
wschon 1:2129bb91c172 48 * - when the usb_thread receives the event, it:
wschon 1:2129bb91c172 49 * - call the callback attached to the endpoint where the td is attached
wschon 1:2129bb91c172 50 */
wschon 1:2129bb91c172 51 void USBHost::usb_process() {
wschon 1:2129bb91c172 52
wschon 1:2129bb91c172 53 bool controlListState;
wschon 1:2129bb91c172 54 bool bulkListState;
wschon 1:2129bb91c172 55 bool interruptListState;
wschon 1:2129bb91c172 56 USBEndpoint * ep;
wschon 1:2129bb91c172 57 uint8_t i, j, res, timeout_set_addr = 10;
wschon 1:2129bb91c172 58 uint8_t buf[8];
wschon 1:2129bb91c172 59 bool too_many_hub;
wschon 1:2129bb91c172 60 int idx;
wschon 1:2129bb91c172 61
wschon 1:2129bb91c172 62 #if DEBUG_TRANSFER
wschon 1:2129bb91c172 63 uint8_t * buf_transfer;
wschon 1:2129bb91c172 64 #endif
wschon 1:2129bb91c172 65
wschon 1:2129bb91c172 66 #if MAX_HUB_NB
wschon 1:2129bb91c172 67 uint8_t k;
wschon 1:2129bb91c172 68 #endif
wschon 1:2129bb91c172 69
wschon 1:2129bb91c172 70 while(1) {
wschon 1:2129bb91c172 71 osEvent evt = mail_usb_event.get();
wschon 1:2129bb91c172 72
wschon 1:2129bb91c172 73 if (evt.status == osEventMail) {
wschon 1:2129bb91c172 74
wschon 1:2129bb91c172 75 l4 = !l4;
wschon 1:2129bb91c172 76 message_t * usb_msg = (message_t*)evt.value.p;
wschon 1:2129bb91c172 77
wschon 1:2129bb91c172 78 switch (usb_msg->event_id) {
wschon 1:2129bb91c172 79
wschon 1:2129bb91c172 80 // a new device has been connected
wschon 1:2129bb91c172 81 case DEVICE_CONNECTED_EVENT:
wschon 1:2129bb91c172 82 too_many_hub = false;
wschon 1:2129bb91c172 83 buf[4] = 0;
wschon 1:2129bb91c172 84
wschon 1:2129bb91c172 85 usb_mutex.lock();
wschon 1:2129bb91c172 86
wschon 1:2129bb91c172 87 for (i = 0; i < MAX_DEVICE_CONNECTED; i++) {
wschon 1:2129bb91c172 88 if (!deviceInUse[i]) {
wschon 1:2129bb91c172 89 USB_DBG_EVENT("new device connected: %p\r\n", &devices[i]);
wschon 1:2129bb91c172 90 devices[i].init(usb_msg->hub, usb_msg->port, usb_msg->lowSpeed);
wschon 1:2129bb91c172 91 deviceReset[i] = false;
wschon 1:2129bb91c172 92 deviceInited[i] = true;
wschon 1:2129bb91c172 93 break;
wschon 1:2129bb91c172 94 }
wschon 1:2129bb91c172 95 }
wschon 1:2129bb91c172 96
wschon 1:2129bb91c172 97 if (i == MAX_DEVICE_CONNECTED) {
wschon 1:2129bb91c172 98 USB_ERR("Too many device connected!!\r\n");
wschon 1:2129bb91c172 99 deviceInited[i] = false;
wschon 1:2129bb91c172 100 usb_mutex.unlock();
wschon 1:2129bb91c172 101 continue;
wschon 1:2129bb91c172 102 }
wschon 1:2129bb91c172 103
wschon 1:2129bb91c172 104 if (!controlEndpointAllocated) {
wschon 1:2129bb91c172 105 control = newEndpoint(CONTROL_ENDPOINT, OUT, 0x08, 0x00);
wschon 1:2129bb91c172 106 addEndpoint(NULL, 0, (USBEndpoint*)control);
wschon 1:2129bb91c172 107 controlEndpointAllocated = true;
wschon 1:2129bb91c172 108 }
wschon 1:2129bb91c172 109
wschon 1:2129bb91c172 110 #if MAX_HUB_NB
wschon 1:2129bb91c172 111 if (usb_msg->hub_parent)
wschon 1:2129bb91c172 112 devices[i].setHubParent((USBHostHub *)(usb_msg->hub_parent));
wschon 1:2129bb91c172 113 #endif
wschon 1:2129bb91c172 114
wschon 1:2129bb91c172 115 for (j = 0; j < timeout_set_addr; j++) {
wschon 1:2129bb91c172 116
wschon 1:2129bb91c172 117 resetDevice(&devices[i]);
wschon 1:2129bb91c172 118
wschon 1:2129bb91c172 119 // set size of control endpoint
wschon 1:2129bb91c172 120 devices[i].setSizeControlEndpoint(8);
wschon 1:2129bb91c172 121
wschon 1:2129bb91c172 122 devices[i].activeAddress(false);
wschon 1:2129bb91c172 123
wschon 1:2129bb91c172 124 // get first 8 bit of device descriptor
wschon 1:2129bb91c172 125 // and check if we deal with a hub
wschon 1:2129bb91c172 126 USB_DBG("usb_thread read device descriptor on dev: %p\r\n", &devices[i]);
wschon 1:2129bb91c172 127 res = getDeviceDescriptor(&devices[i], buf, 8);
wschon 1:2129bb91c172 128
wschon 1:2129bb91c172 129 if (res != USB_TYPE_OK) {
wschon 1:2129bb91c172 130 USB_ERR("usb_thread could not read dev descr");
wschon 1:2129bb91c172 131 continue;
wschon 1:2129bb91c172 132 }
wschon 1:2129bb91c172 133
wschon 1:2129bb91c172 134 // set size of control endpoint
wschon 1:2129bb91c172 135 devices[i].setSizeControlEndpoint(buf[7]);
wschon 1:2129bb91c172 136
wschon 1:2129bb91c172 137 // second step: set an address to the device
wschon 1:2129bb91c172 138 res = setAddress(&devices[i], devices[i].getAddress());
wschon 1:2129bb91c172 139
wschon 1:2129bb91c172 140 if (res != USB_TYPE_OK) {
wschon 1:2129bb91c172 141 USB_ERR("SET ADDR FAILED");
wschon 1:2129bb91c172 142 continue;
wschon 1:2129bb91c172 143 }
wschon 1:2129bb91c172 144 devices[i].activeAddress(true);
wschon 1:2129bb91c172 145 USB_DBG("Address of %p: %d", &devices[i], devices[i].getAddress());
wschon 1:2129bb91c172 146
wschon 1:2129bb91c172 147 // try to read again the device descriptor to check if the device
wschon 1:2129bb91c172 148 // answers to its new address
wschon 1:2129bb91c172 149 res = getDeviceDescriptor(&devices[i], buf, 8);
wschon 1:2129bb91c172 150
wschon 1:2129bb91c172 151 if (res == USB_TYPE_OK) {
wschon 1:2129bb91c172 152 break;
wschon 1:2129bb91c172 153 }
wschon 1:2129bb91c172 154
wschon 1:2129bb91c172 155 Thread::wait(100);
wschon 1:2129bb91c172 156 }
wschon 1:2129bb91c172 157
wschon 1:2129bb91c172 158 USB_INFO("New device connected: %p [hub: %d - port: %d]", &devices[i], usb_msg->hub, usb_msg->port);
wschon 1:2129bb91c172 159
wschon 1:2129bb91c172 160 #if MAX_HUB_NB
wschon 1:2129bb91c172 161 if (buf[4] == HUB_CLASS) {
wschon 1:2129bb91c172 162 for (k = 0; k < MAX_HUB_NB; k++) {
wschon 1:2129bb91c172 163 if (hub_in_use[k] == false) {
wschon 1:2129bb91c172 164 for (uint8_t j = 0; j < MAX_TRY_ENUMERATE_HUB; j++) {
wschon 1:2129bb91c172 165 if (hubs[k].connect(&devices[i])) {
wschon 1:2129bb91c172 166 devices[i].hub = &hubs[k];
wschon 1:2129bb91c172 167 hub_in_use[k] = true;
wschon 1:2129bb91c172 168 break;
wschon 1:2129bb91c172 169 }
wschon 1:2129bb91c172 170 }
wschon 1:2129bb91c172 171 if (hub_in_use[k] == true)
wschon 1:2129bb91c172 172 break;
wschon 1:2129bb91c172 173 }
wschon 1:2129bb91c172 174 }
wschon 1:2129bb91c172 175
wschon 1:2129bb91c172 176 if (k == MAX_HUB_NB) {
wschon 1:2129bb91c172 177 USB_ERR("Too many hubs connected!!\r\n");
wschon 1:2129bb91c172 178 too_many_hub = true;
wschon 1:2129bb91c172 179 }
wschon 1:2129bb91c172 180 }
wschon 1:2129bb91c172 181
wschon 1:2129bb91c172 182 if (usb_msg->hub_parent)
wschon 1:2129bb91c172 183 ((USBHostHub *)(usb_msg->hub_parent))->deviceConnected(&devices[i]);
wschon 1:2129bb91c172 184 #endif
wschon 1:2129bb91c172 185
wschon 1:2129bb91c172 186 if ((i < MAX_DEVICE_CONNECTED) && !too_many_hub) {
wschon 1:2129bb91c172 187 deviceInUse[i] = true;
wschon 1:2129bb91c172 188 }
wschon 1:2129bb91c172 189
wschon 1:2129bb91c172 190 usb_mutex.unlock();
wschon 1:2129bb91c172 191
wschon 1:2129bb91c172 192 break;
wschon 1:2129bb91c172 193
wschon 1:2129bb91c172 194 // a device has been disconnected
wschon 1:2129bb91c172 195 case DEVICE_DISCONNECTED_EVENT:
wschon 1:2129bb91c172 196
wschon 1:2129bb91c172 197 usb_mutex.lock();
wschon 1:2129bb91c172 198
wschon 1:2129bb91c172 199 controlListState = disableList(CONTROL_ENDPOINT);
wschon 1:2129bb91c172 200 bulkListState = disableList(BULK_ENDPOINT);
wschon 1:2129bb91c172 201 interruptListState = disableList(INTERRUPT_ENDPOINT);
wschon 1:2129bb91c172 202
wschon 1:2129bb91c172 203 idx = findDevice(usb_msg->hub, usb_msg->port, (USBHostHub *)(usb_msg->hub_parent));
wschon 1:2129bb91c172 204 if (idx != -1) {
wschon 1:2129bb91c172 205 freeDevice((USBDeviceConnected*)&devices[idx]);
wschon 1:2129bb91c172 206 }
wschon 1:2129bb91c172 207
wschon 1:2129bb91c172 208 if (controlListState) enableList(CONTROL_ENDPOINT);
wschon 1:2129bb91c172 209 if (bulkListState) enableList(BULK_ENDPOINT);
wschon 1:2129bb91c172 210 if (interruptListState) enableList(INTERRUPT_ENDPOINT);
wschon 1:2129bb91c172 211
wschon 1:2129bb91c172 212 usb_mutex.unlock();
wschon 1:2129bb91c172 213
wschon 1:2129bb91c172 214 break;
wschon 1:2129bb91c172 215
wschon 1:2129bb91c172 216 // a td has been processed
wschon 1:2129bb91c172 217 // call callback on the ed associated to the td
wschon 1:2129bb91c172 218 // we are not in ISR -> users can use printf in their callback method
wschon 1:2129bb91c172 219 case TD_PROCESSED_EVENT:
wschon 1:2129bb91c172 220 ep = (USBEndpoint *) ((HCTD *)usb_msg->td_addr)->ep;
wschon 1:2129bb91c172 221 if (usb_msg->td_state == USB_TYPE_IDLE) {
wschon 1:2129bb91c172 222 USB_DBG_EVENT("call callback on td %p [ep: %p state: %s - dev: %p - %s]", usb_msg->td_addr, ep, ep->getStateString(), ep->dev, ep->dev->getName(ep->getIntfNb()));
wschon 1:2129bb91c172 223
wschon 1:2129bb91c172 224 #if DEBUG_TRANSFER
wschon 1:2129bb91c172 225 if (ep->getDir() == IN) {
wschon 1:2129bb91c172 226 buf_transfer = ep->getBufStart();
wschon 1:2129bb91c172 227 printf("READ SUCCESS [%d bytes transferred - td: 0x%08X] on ep: [%p - addr: %02X]: ", ep->getLengthTransferred(), usb_msg->td_addr, ep, ep->getAddress());
wschon 1:2129bb91c172 228 for (int i = 0; i < ep->getLengthTransferred(); i++)
wschon 1:2129bb91c172 229 printf("%02X ", buf_transfer[i]);
wschon 1:2129bb91c172 230 printf("\r\n\r\n");
wschon 1:2129bb91c172 231 }
wschon 1:2129bb91c172 232 #endif
wschon 1:2129bb91c172 233 ep->call();
wschon 1:2129bb91c172 234 } else {
wschon 1:2129bb91c172 235 idx = findDevice(ep->dev);
wschon 1:2129bb91c172 236 if (idx != -1) {
wschon 1:2129bb91c172 237 if (deviceInUse[idx]) {
wschon 1:2129bb91c172 238 USB_WARN("td %p processed but not in idle state: %s [ep: %p - dev: %p - %s]", usb_msg->td_addr, ep->getStateString(), ep, ep->dev, ep->dev->getName(ep->getIntfNb()));
wschon 1:2129bb91c172 239 ep->setState(USB_TYPE_IDLE);
wschon 1:2129bb91c172 240 }
wschon 1:2129bb91c172 241 }
wschon 1:2129bb91c172 242 }
wschon 1:2129bb91c172 243 break;
wschon 1:2129bb91c172 244 }
wschon 1:2129bb91c172 245
wschon 1:2129bb91c172 246 mail_usb_event.free(usb_msg);
wschon 1:2129bb91c172 247 }
wschon 1:2129bb91c172 248 }
wschon 1:2129bb91c172 249 }
wschon 1:2129bb91c172 250
wschon 1:2129bb91c172 251 /* static */void USBHost::usb_process_static(void const * arg) {
wschon 1:2129bb91c172 252 ((USBHost *)arg)->usb_process();
wschon 1:2129bb91c172 253 }
wschon 1:2129bb91c172 254
wschon 1:2129bb91c172 255 USBHost::USBHost() : usbThread(USBHost::usb_process_static, (void *)this, osPriorityNormal, USB_THREAD_STACK)
wschon 1:2129bb91c172 256 {
wschon 1:2129bb91c172 257 headControlEndpoint = NULL;
wschon 1:2129bb91c172 258 headBulkEndpoint = NULL;
wschon 1:2129bb91c172 259 headInterruptEndpoint = NULL;
wschon 1:2129bb91c172 260 tailControlEndpoint = NULL;
wschon 1:2129bb91c172 261 tailBulkEndpoint = NULL;
wschon 1:2129bb91c172 262 tailInterruptEndpoint = NULL;
wschon 1:2129bb91c172 263
wschon 1:2129bb91c172 264 lenReportDescr = 0;
wschon 1:2129bb91c172 265
wschon 1:2129bb91c172 266 controlEndpointAllocated = false;
wschon 1:2129bb91c172 267
wschon 1:2129bb91c172 268 for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) {
wschon 1:2129bb91c172 269 deviceInUse[i] = false;
wschon 1:2129bb91c172 270 devices[i].setAddress(i + 1);
wschon 1:2129bb91c172 271 deviceReset[i] = false;
wschon 1:2129bb91c172 272 deviceInited[i] = false;
wschon 1:2129bb91c172 273 for (uint8_t j = 0; j < MAX_INTF; j++)
wschon 1:2129bb91c172 274 deviceAttachedDriver[i][j] = false;
wschon 1:2129bb91c172 275 }
wschon 1:2129bb91c172 276
wschon 1:2129bb91c172 277 #if MAX_HUB_NB
wschon 1:2129bb91c172 278 for (uint8_t i = 0; i < MAX_HUB_NB; i++) {
wschon 1:2129bb91c172 279 hubs[i].setHost(this);
wschon 1:2129bb91c172 280 hub_in_use[i] = false;
wschon 1:2129bb91c172 281 }
wschon 1:2129bb91c172 282 #endif
wschon 1:2129bb91c172 283 }
wschon 1:2129bb91c172 284
wschon 1:2129bb91c172 285
wschon 1:2129bb91c172 286 void USBHost::transferCompleted(volatile uint32_t addr)
wschon 1:2129bb91c172 287 {
wschon 1:2129bb91c172 288 uint8_t state;
wschon 1:2129bb91c172 289
wschon 1:2129bb91c172 290 if(addr == NULL)
wschon 1:2129bb91c172 291 return;
wschon 1:2129bb91c172 292
wschon 1:2129bb91c172 293 volatile HCTD* tdList = NULL;
wschon 1:2129bb91c172 294
wschon 1:2129bb91c172 295 //First we must reverse the list order and dequeue each TD
wschon 1:2129bb91c172 296 do {
wschon 1:2129bb91c172 297 volatile HCTD* td = (volatile HCTD*)addr;
wschon 1:2129bb91c172 298 addr = (uint32_t)td->nextTD; //Dequeue from physical list
wschon 1:2129bb91c172 299 td->nextTD = tdList; //Enqueue into reversed list
wschon 1:2129bb91c172 300 tdList = td;
wschon 1:2129bb91c172 301 } while(addr);
wschon 1:2129bb91c172 302
wschon 1:2129bb91c172 303 while(tdList != NULL) {
wschon 1:2129bb91c172 304 volatile HCTD* td = tdList;
wschon 1:2129bb91c172 305 tdList = (volatile HCTD*)td->nextTD; //Dequeue element now as it could be modified below
wschon 1:2129bb91c172 306 if (td->ep != NULL) {
wschon 1:2129bb91c172 307 USBEndpoint * ep = (USBEndpoint *)(td->ep);
wschon 1:2129bb91c172 308
wschon 1:2129bb91c172 309 if (((HCTD *)td)->control >> 28) {
wschon 1:2129bb91c172 310 state = ((HCTD *)td)->control >> 28;
wschon 1:2129bb91c172 311 } else {
wschon 1:2129bb91c172 312 if (td->currBufPtr)
wschon 1:2129bb91c172 313 ep->setLengthTransferred((uint32_t)td->currBufPtr - (uint32_t)ep->getBufStart());
wschon 1:2129bb91c172 314 state = 16 /*USB_TYPE_IDLE*/;
wschon 1:2129bb91c172 315 }
wschon 1:2129bb91c172 316
wschon 1:2129bb91c172 317 ep->unqueueTransfer(td);
wschon 1:2129bb91c172 318
wschon 1:2129bb91c172 319 if (ep->getType() != CONTROL_ENDPOINT) {
wschon 1:2129bb91c172 320 // callback on the processed td will be called from the usb_thread (not in ISR)
wschon 1:2129bb91c172 321 message_t * usb_msg = mail_usb_event.alloc();
wschon 1:2129bb91c172 322 usb_msg->event_id = TD_PROCESSED_EVENT;
wschon 1:2129bb91c172 323 usb_msg->td_addr = (void *)td;
wschon 1:2129bb91c172 324 usb_msg->td_state = state;
wschon 1:2129bb91c172 325 mail_usb_event.put(usb_msg);
wschon 1:2129bb91c172 326 }
wschon 1:2129bb91c172 327 ep->setState(state);
wschon 1:2129bb91c172 328 ep->ep_queue.put((uint8_t*)1);
wschon 1:2129bb91c172 329 }
wschon 1:2129bb91c172 330 }
wschon 1:2129bb91c172 331 }
wschon 1:2129bb91c172 332
wschon 1:2129bb91c172 333 USBHost * USBHost::getHostInst()
wschon 1:2129bb91c172 334 {
wschon 1:2129bb91c172 335 if (instHost == NULL) {
wschon 1:2129bb91c172 336 instHost = new USBHost();
wschon 1:2129bb91c172 337 instHost->init();
wschon 1:2129bb91c172 338 }
wschon 1:2129bb91c172 339 return instHost;
wschon 1:2129bb91c172 340 }
wschon 1:2129bb91c172 341
wschon 1:2129bb91c172 342
wschon 1:2129bb91c172 343 /*
wschon 1:2129bb91c172 344 * Called when a device has been connected
wschon 1:2129bb91c172 345 * Called in ISR!!!! (no printf)
wschon 1:2129bb91c172 346 */
wschon 1:2129bb91c172 347 /* virtual */ void USBHost::deviceConnected(int hub, int port, bool lowSpeed, USBHostHub * hub_parent)
wschon 1:2129bb91c172 348 {
wschon 1:2129bb91c172 349 // be sure that the new device connected is not already connected...
wschon 1:2129bb91c172 350 int idx = findDevice(hub, port, hub_parent);
wschon 1:2129bb91c172 351 if (idx != -1) {
wschon 1:2129bb91c172 352 if (deviceInited[idx])
wschon 1:2129bb91c172 353 return;
wschon 1:2129bb91c172 354 }
wschon 1:2129bb91c172 355
wschon 1:2129bb91c172 356 message_t * usb_msg = mail_usb_event.alloc();
wschon 1:2129bb91c172 357 usb_msg->event_id = DEVICE_CONNECTED_EVENT;
wschon 1:2129bb91c172 358 usb_msg->hub = hub;
wschon 1:2129bb91c172 359 usb_msg->port = port;
wschon 1:2129bb91c172 360 usb_msg->lowSpeed = lowSpeed;
wschon 1:2129bb91c172 361 usb_msg->hub_parent = hub_parent;
wschon 1:2129bb91c172 362 mail_usb_event.put(usb_msg);
wschon 1:2129bb91c172 363 }
wschon 1:2129bb91c172 364
wschon 1:2129bb91c172 365 /*
wschon 1:2129bb91c172 366 * Called when a device has been disconnected
wschon 1:2129bb91c172 367 * Called in ISR!!!! (no printf)
wschon 1:2129bb91c172 368 */
wschon 1:2129bb91c172 369 /* virtual */ void USBHost::deviceDisconnected(int hub, int port, USBHostHub * hub_parent, volatile uint32_t addr)
wschon 1:2129bb91c172 370 {
wschon 1:2129bb91c172 371 // be sure that the device disconnected is connected...
wschon 1:2129bb91c172 372 int idx = findDevice(hub, port, hub_parent);
wschon 1:2129bb91c172 373 if (idx != -1) {
wschon 1:2129bb91c172 374 if (!deviceInUse[idx])
wschon 1:2129bb91c172 375 return;
wschon 1:2129bb91c172 376 } else {
wschon 1:2129bb91c172 377 return;
wschon 1:2129bb91c172 378 }
wschon 1:2129bb91c172 379
wschon 1:2129bb91c172 380 message_t * usb_msg = mail_usb_event.alloc();
wschon 1:2129bb91c172 381 usb_msg->event_id = DEVICE_DISCONNECTED_EVENT;
wschon 1:2129bb91c172 382 usb_msg->hub = hub;
wschon 1:2129bb91c172 383 usb_msg->port = port;
wschon 1:2129bb91c172 384 usb_msg->hub_parent = hub_parent;
wschon 1:2129bb91c172 385 mail_usb_event.put(usb_msg);
wschon 1:2129bb91c172 386 }
wschon 1:2129bb91c172 387
wschon 1:2129bb91c172 388 void USBHost::freeDevice(USBDeviceConnected * dev)
wschon 1:2129bb91c172 389 {
wschon 1:2129bb91c172 390 USBEndpoint * ep = NULL;
wschon 1:2129bb91c172 391 HCED * ed = NULL;
wschon 1:2129bb91c172 392
wschon 1:2129bb91c172 393 #if MAX_HUB_NB
wschon 1:2129bb91c172 394 if (dev->getClass() == HUB_CLASS) {
wschon 1:2129bb91c172 395 if (dev->hub == NULL) {
wschon 1:2129bb91c172 396 USB_ERR("HUB NULL!!!!!\r\n");
wschon 1:2129bb91c172 397 } else {
wschon 1:2129bb91c172 398 dev->hub->hubDisconnected();
wschon 1:2129bb91c172 399 for (uint8_t i = 0; i < MAX_HUB_NB; i++) {
wschon 1:2129bb91c172 400 if (dev->hub == &hubs[i]) {
wschon 1:2129bb91c172 401 hub_in_use[i] = false;
wschon 1:2129bb91c172 402 break;
wschon 1:2129bb91c172 403 }
wschon 1:2129bb91c172 404 }
wschon 1:2129bb91c172 405 }
wschon 1:2129bb91c172 406 }
wschon 1:2129bb91c172 407
wschon 1:2129bb91c172 408 // notify hub parent that this device has been disconnected
wschon 1:2129bb91c172 409 if (dev->getHubParent())
wschon 1:2129bb91c172 410 dev->getHubParent()->deviceDisconnected(dev);
wschon 1:2129bb91c172 411
wschon 1:2129bb91c172 412 #endif
wschon 1:2129bb91c172 413
wschon 1:2129bb91c172 414 int idx = findDevice(dev);
wschon 1:2129bb91c172 415 if (idx != -1) {
wschon 1:2129bb91c172 416 deviceInUse[idx] = false;
wschon 1:2129bb91c172 417 deviceReset[idx] = false;
wschon 1:2129bb91c172 418
wschon 1:2129bb91c172 419 for (uint8_t j = 0; j < MAX_INTF; j++) {
wschon 1:2129bb91c172 420 deviceAttachedDriver[idx][j] = false;
wschon 1:2129bb91c172 421 if (dev->getInterface(j) != NULL) {
wschon 1:2129bb91c172 422 USB_DBG("FREE INTF %d on dev: %p, %p, nb_endpot: %d, %s", j, (void *)dev->getInterface(j), dev, dev->getInterface(j)->nb_endpoint, dev->getName(j));
wschon 1:2129bb91c172 423 for (int i = 0; i < dev->getInterface(j)->nb_endpoint; i++) {
wschon 1:2129bb91c172 424 if ((ep = dev->getEndpoint(j, i)) != NULL) {
wschon 1:2129bb91c172 425 ed = (HCED *)ep->getHCED();
wschon 1:2129bb91c172 426 ed->control |= (1 << 13); //sKip bit
wschon 1:2129bb91c172 427 unqueueEndpoint(ep);
wschon 1:2129bb91c172 428
wschon 1:2129bb91c172 429 freeTD((volatile uint8_t*)ep->getTDList()[0]);
wschon 1:2129bb91c172 430 freeTD((volatile uint8_t*)ep->getTDList()[1]);
wschon 1:2129bb91c172 431
wschon 1:2129bb91c172 432 freeED((uint8_t *)ep->getHCED());
wschon 1:2129bb91c172 433 }
wschon 1:2129bb91c172 434 printList(BULK_ENDPOINT);
wschon 1:2129bb91c172 435 printList(INTERRUPT_ENDPOINT);
wschon 1:2129bb91c172 436 }
wschon 1:2129bb91c172 437 USB_INFO("Device disconnected [%p - %s - hub: %d - port: %d]", dev, dev->getName(j), dev->getHub(), dev->getPort());
wschon 1:2129bb91c172 438 }
wschon 1:2129bb91c172 439 }
wschon 1:2129bb91c172 440 dev->disconnect();
wschon 1:2129bb91c172 441 }
wschon 1:2129bb91c172 442 }
wschon 1:2129bb91c172 443
wschon 1:2129bb91c172 444
wschon 1:2129bb91c172 445 void USBHost::unqueueEndpoint(USBEndpoint * ep)
wschon 1:2129bb91c172 446 {
wschon 1:2129bb91c172 447 USBEndpoint * prec = NULL;
wschon 1:2129bb91c172 448 USBEndpoint * current = NULL;
wschon 1:2129bb91c172 449
wschon 1:2129bb91c172 450 for (int i = 0; i < 2; i++) {
wschon 1:2129bb91c172 451 current = (i == 0) ? (USBEndpoint*)headBulkEndpoint : (USBEndpoint*)headInterruptEndpoint;
wschon 1:2129bb91c172 452 prec = current;
wschon 1:2129bb91c172 453 while (current != NULL) {
wschon 1:2129bb91c172 454 if (current == ep) {
wschon 1:2129bb91c172 455 if (current->nextEndpoint() != NULL) {
wschon 1:2129bb91c172 456 prec->queueEndpoint(current->nextEndpoint());
wschon 1:2129bb91c172 457 if (current == headBulkEndpoint) {
wschon 1:2129bb91c172 458 updateBulkHeadED((uint32_t)current->nextEndpoint()->getHCED());
wschon 1:2129bb91c172 459 headBulkEndpoint = current->nextEndpoint();
wschon 1:2129bb91c172 460 } else if (current == headInterruptEndpoint) {
wschon 1:2129bb91c172 461 updateInterruptHeadED((uint32_t)current->nextEndpoint()->getHCED());
wschon 1:2129bb91c172 462 headInterruptEndpoint = current->nextEndpoint();
wschon 1:2129bb91c172 463 }
wschon 1:2129bb91c172 464 }
wschon 1:2129bb91c172 465 // here we are dequeuing the queue of ed
wschon 1:2129bb91c172 466 // we need to update the tail pointer
wschon 1:2129bb91c172 467 else {
wschon 1:2129bb91c172 468 prec->queueEndpoint(NULL);
wschon 1:2129bb91c172 469 if (current == headBulkEndpoint) {
wschon 1:2129bb91c172 470 updateBulkHeadED(0);
wschon 1:2129bb91c172 471 headBulkEndpoint = current->nextEndpoint();
wschon 1:2129bb91c172 472 } else if (current == headInterruptEndpoint) {
wschon 1:2129bb91c172 473 updateInterruptHeadED(0);
wschon 1:2129bb91c172 474 headInterruptEndpoint = current->nextEndpoint();
wschon 1:2129bb91c172 475 }
wschon 1:2129bb91c172 476
wschon 1:2129bb91c172 477 // modify tail
wschon 1:2129bb91c172 478 switch (current->getType()) {
wschon 1:2129bb91c172 479 case BULK_ENDPOINT:
wschon 1:2129bb91c172 480 tailBulkEndpoint = prec;
wschon 1:2129bb91c172 481 break;
wschon 1:2129bb91c172 482 case INTERRUPT_ENDPOINT:
wschon 1:2129bb91c172 483 tailInterruptEndpoint = prec;
wschon 1:2129bb91c172 484 break;
wschon 1:2129bb91c172 485 }
wschon 1:2129bb91c172 486 }
wschon 1:2129bb91c172 487 current->setState(USB_TYPE_FREE);
wschon 1:2129bb91c172 488 return;
wschon 1:2129bb91c172 489 }
wschon 1:2129bb91c172 490 prec = current;
wschon 1:2129bb91c172 491 current = current->nextEndpoint();
wschon 1:2129bb91c172 492 }
wschon 1:2129bb91c172 493 }
wschon 1:2129bb91c172 494 }
wschon 1:2129bb91c172 495
wschon 1:2129bb91c172 496
wschon 1:2129bb91c172 497 USBDeviceConnected * USBHost::getDevice(uint8_t index)
wschon 1:2129bb91c172 498 {
wschon 1:2129bb91c172 499 if ((index >= MAX_DEVICE_CONNECTED) || (!deviceInUse[index])) {
wschon 1:2129bb91c172 500 return NULL;
wschon 1:2129bb91c172 501 }
wschon 1:2129bb91c172 502 return (USBDeviceConnected*)&devices[index];
wschon 1:2129bb91c172 503 }
wschon 1:2129bb91c172 504
wschon 1:2129bb91c172 505 // create an USBEndpoint descriptor. the USBEndpoint is not linked
wschon 1:2129bb91c172 506 USBEndpoint * USBHost::newEndpoint(ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir, uint32_t size, uint8_t addr)
wschon 1:2129bb91c172 507 {
wschon 1:2129bb91c172 508 int i = 0;
wschon 1:2129bb91c172 509 HCED * ed = (HCED *)getED();
wschon 1:2129bb91c172 510 HCTD* td_list[2] = { (HCTD*)getTD(), (HCTD*)getTD() };
wschon 1:2129bb91c172 511
wschon 1:2129bb91c172 512 memset((void *)td_list[0], 0x00, sizeof(HCTD));
wschon 1:2129bb91c172 513 memset((void *)td_list[1], 0x00, sizeof(HCTD));
wschon 1:2129bb91c172 514
wschon 1:2129bb91c172 515 // search a free USBEndpoint
wschon 1:2129bb91c172 516 for (i = 0; i < MAX_ENDPOINT; i++) {
wschon 1:2129bb91c172 517 if (endpoints[i].getState() == USB_TYPE_FREE) {
wschon 1:2129bb91c172 518 endpoints[i].init(ed, type, dir, size, addr, td_list);
wschon 1:2129bb91c172 519 USB_DBG("USBEndpoint created (%p): type: %d, dir: %d, size: %d, addr: %d, state: %s", &endpoints[i], type, dir, size, addr, endpoints[i].getStateString());
wschon 1:2129bb91c172 520 return &endpoints[i];
wschon 1:2129bb91c172 521 }
wschon 1:2129bb91c172 522 }
wschon 1:2129bb91c172 523 USB_ERR("could not allocate more endpoints!!!!");
wschon 1:2129bb91c172 524 return NULL;
wschon 1:2129bb91c172 525 }
wschon 1:2129bb91c172 526
wschon 1:2129bb91c172 527
wschon 1:2129bb91c172 528 USB_TYPE USBHost::resetDevice(USBDeviceConnected * dev)
wschon 1:2129bb91c172 529 {
wschon 1:2129bb91c172 530 int index = findDevice(dev);
wschon 1:2129bb91c172 531 if (index != -1) {
wschon 1:2129bb91c172 532 USB_DBG("Resetting hub %d, port %d\n", dev->getHub(), dev->getPort());
wschon 1:2129bb91c172 533 Thread::wait(100);
wschon 1:2129bb91c172 534 if (dev->getHub() == 0) {
wschon 1:2129bb91c172 535 resetRootHub();
wschon 1:2129bb91c172 536 }
wschon 1:2129bb91c172 537 #if MAX_HUB_NB
wschon 1:2129bb91c172 538 else {
wschon 1:2129bb91c172 539 dev->getHubParent()->portReset(dev->getPort());
wschon 1:2129bb91c172 540 }
wschon 1:2129bb91c172 541 #endif
wschon 1:2129bb91c172 542 Thread::wait(100);
wschon 1:2129bb91c172 543 deviceReset[index] = true;
wschon 1:2129bb91c172 544 return USB_TYPE_OK;
wschon 1:2129bb91c172 545 }
wschon 1:2129bb91c172 546
wschon 1:2129bb91c172 547 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 548 }
wschon 1:2129bb91c172 549
wschon 1:2129bb91c172 550 // link the USBEndpoint to the linked list and attach an USBEndpoint to a device
wschon 1:2129bb91c172 551 bool USBHost::addEndpoint(USBDeviceConnected * dev, uint8_t intf_nb, USBEndpoint * ep)
wschon 1:2129bb91c172 552 {
wschon 1:2129bb91c172 553
wschon 1:2129bb91c172 554 if (ep == NULL) {
wschon 1:2129bb91c172 555 return false;
wschon 1:2129bb91c172 556 }
wschon 1:2129bb91c172 557
wschon 1:2129bb91c172 558 HCED * prevEd;
wschon 1:2129bb91c172 559
wschon 1:2129bb91c172 560 // set device address in the USBEndpoint descriptor
wschon 1:2129bb91c172 561 if (dev == NULL) {
wschon 1:2129bb91c172 562 ep->setDeviceAddress(0);
wschon 1:2129bb91c172 563 } else {
wschon 1:2129bb91c172 564 ep->setDeviceAddress(dev->getAddress());
wschon 1:2129bb91c172 565 }
wschon 1:2129bb91c172 566
wschon 1:2129bb91c172 567 if ((dev != NULL) && dev->getSpeed()) {
wschon 1:2129bb91c172 568 ep->setSpeed(dev->getSpeed());
wschon 1:2129bb91c172 569 }
wschon 1:2129bb91c172 570
wschon 1:2129bb91c172 571 ep->setIntfNb(intf_nb);
wschon 1:2129bb91c172 572
wschon 1:2129bb91c172 573 // queue the new USBEndpoint on the ED list
wschon 1:2129bb91c172 574 switch (ep->getType()) {
wschon 1:2129bb91c172 575
wschon 1:2129bb91c172 576 case CONTROL_ENDPOINT:
wschon 1:2129bb91c172 577 prevEd = ( HCED*) controlHeadED();
wschon 1:2129bb91c172 578 if (!prevEd) {
wschon 1:2129bb91c172 579 updateControlHeadED((uint32_t) ep->getHCED());
wschon 1:2129bb91c172 580 USB_DBG_TRANSFER("First control USBEndpoint: %08X", (uint32_t) ep->getHCED());
wschon 1:2129bb91c172 581 headControlEndpoint = ep;
wschon 1:2129bb91c172 582 tailControlEndpoint = ep;
wschon 1:2129bb91c172 583 return true;
wschon 1:2129bb91c172 584 }
wschon 1:2129bb91c172 585 tailControlEndpoint->queueEndpoint(ep);
wschon 1:2129bb91c172 586 tailControlEndpoint = ep;
wschon 1:2129bb91c172 587 return true;
wschon 1:2129bb91c172 588
wschon 1:2129bb91c172 589 case BULK_ENDPOINT:
wschon 1:2129bb91c172 590 prevEd = ( HCED*) bulkHeadED();
wschon 1:2129bb91c172 591 if (!prevEd) {
wschon 1:2129bb91c172 592 updateBulkHeadED((uint32_t) ep->getHCED());
wschon 1:2129bb91c172 593 USB_DBG_TRANSFER("First bulk USBEndpoint: %08X\r\n", (uint32_t) ep->getHCED());
wschon 1:2129bb91c172 594 headBulkEndpoint = ep;
wschon 1:2129bb91c172 595 tailBulkEndpoint = ep;
wschon 1:2129bb91c172 596 break;
wschon 1:2129bb91c172 597 }
wschon 1:2129bb91c172 598 USB_DBG_TRANSFER("Queue BULK Ed %p after %p\r\n",ep->getHCED(), prevEd);
wschon 1:2129bb91c172 599 tailBulkEndpoint->queueEndpoint(ep);
wschon 1:2129bb91c172 600 tailBulkEndpoint = ep;
wschon 1:2129bb91c172 601 break;
wschon 1:2129bb91c172 602
wschon 1:2129bb91c172 603 case INTERRUPT_ENDPOINT:
wschon 1:2129bb91c172 604 prevEd = ( HCED*) interruptHeadED();
wschon 1:2129bb91c172 605 if (!prevEd) {
wschon 1:2129bb91c172 606 updateInterruptHeadED((uint32_t) ep->getHCED());
wschon 1:2129bb91c172 607 USB_DBG_TRANSFER("First interrupt USBEndpoint: %08X\r\n", (uint32_t) ep->getHCED());
wschon 1:2129bb91c172 608 headInterruptEndpoint = ep;
wschon 1:2129bb91c172 609 tailInterruptEndpoint = ep;
wschon 1:2129bb91c172 610 break;
wschon 1:2129bb91c172 611 }
wschon 1:2129bb91c172 612 USB_DBG_TRANSFER("Queue INTERRUPT Ed %p after %p\r\n",ep->getHCED(), prevEd);
wschon 1:2129bb91c172 613 tailInterruptEndpoint->queueEndpoint(ep);
wschon 1:2129bb91c172 614 tailInterruptEndpoint = ep;
wschon 1:2129bb91c172 615 break;
wschon 1:2129bb91c172 616 default:
wschon 1:2129bb91c172 617 return false;
wschon 1:2129bb91c172 618 }
wschon 1:2129bb91c172 619
wschon 1:2129bb91c172 620 ep->dev = dev;
wschon 1:2129bb91c172 621 dev->addEndpoint(intf_nb, ep);
wschon 1:2129bb91c172 622
wschon 1:2129bb91c172 623 return true;
wschon 1:2129bb91c172 624 }
wschon 1:2129bb91c172 625
wschon 1:2129bb91c172 626
wschon 1:2129bb91c172 627 int USBHost::findDevice(USBDeviceConnected * dev)
wschon 1:2129bb91c172 628 {
wschon 1:2129bb91c172 629 for (int i = 0; i < MAX_DEVICE_CONNECTED; i++) {
wschon 1:2129bb91c172 630 if (dev == &devices[i]) {
wschon 1:2129bb91c172 631 return i;
wschon 1:2129bb91c172 632 }
wschon 1:2129bb91c172 633 }
wschon 1:2129bb91c172 634 return -1;
wschon 1:2129bb91c172 635 }
wschon 1:2129bb91c172 636
wschon 1:2129bb91c172 637 int USBHost::findDevice(uint8_t hub, uint8_t port, USBHostHub * hub_parent)
wschon 1:2129bb91c172 638 {
wschon 1:2129bb91c172 639 for (int i = 0; i < MAX_DEVICE_CONNECTED; i++) {
wschon 1:2129bb91c172 640 if (devices[i].getHub() == hub && devices[i].getPort() == port) {
wschon 1:2129bb91c172 641 if (hub_parent != NULL) {
wschon 1:2129bb91c172 642 if (hub_parent == devices[i].getHubParent())
wschon 1:2129bb91c172 643 return i;
wschon 1:2129bb91c172 644 } else {
wschon 1:2129bb91c172 645 return i;
wschon 1:2129bb91c172 646 }
wschon 1:2129bb91c172 647 }
wschon 1:2129bb91c172 648 }
wschon 1:2129bb91c172 649 return -1;
wschon 1:2129bb91c172 650 }
wschon 1:2129bb91c172 651
wschon 1:2129bb91c172 652 void USBHost::printList(ENDPOINT_TYPE type)
wschon 1:2129bb91c172 653 {
wschon 1:2129bb91c172 654 #if DEBUG_EP_STATE
wschon 1:2129bb91c172 655 volatile HCED * hced;
wschon 1:2129bb91c172 656 switch(type) {
wschon 1:2129bb91c172 657 case CONTROL_ENDPOINT:
wschon 1:2129bb91c172 658 hced = (HCED *)controlHeadED();
wschon 1:2129bb91c172 659 break;
wschon 1:2129bb91c172 660 case BULK_ENDPOINT:
wschon 1:2129bb91c172 661 hced = (HCED *)bulkHeadED();
wschon 1:2129bb91c172 662 break;
wschon 1:2129bb91c172 663 case INTERRUPT_ENDPOINT:
wschon 1:2129bb91c172 664 hced = (HCED *)interruptHeadED();
wschon 1:2129bb91c172 665 break;
wschon 1:2129bb91c172 666 }
wschon 1:2129bb91c172 667 volatile HCTD * hctd = NULL;
wschon 1:2129bb91c172 668 const char * type_str = (type == BULK_ENDPOINT) ? "BULK" :
wschon 1:2129bb91c172 669 ((type == INTERRUPT_ENDPOINT) ? "INTERRUPT" :
wschon 1:2129bb91c172 670 ((type == CONTROL_ENDPOINT) ? "CONTROL" : "ISOCHRONOUS"));
wschon 1:2129bb91c172 671 printf("State of %s:\r\n", type_str);
wschon 1:2129bb91c172 672 while (hced != NULL) {
wschon 1:2129bb91c172 673 uint8_t dir = ((hced->control & (3 << 11)) >> 11);
wschon 1:2129bb91c172 674 printf("hced: %p [ADDR: %d, DIR: %s, EP_NB: 0x%X]\r\n", hced,
wschon 1:2129bb91c172 675 hced->control & 0x7f,
wschon 1:2129bb91c172 676 (dir == 1) ? "OUT" : ((dir == 0) ? "FROM_TD":"IN"),
wschon 1:2129bb91c172 677 (hced->control & (0xf << 7)) >> 7);
wschon 1:2129bb91c172 678 hctd = (HCTD *)((uint32_t)(hced->headTD) & ~(0xf));
wschon 1:2129bb91c172 679 while (hctd != hced->tailTD) {
wschon 1:2129bb91c172 680 printf("\thctd: %p [DIR: %s]\r\n", hctd, ((hctd->control & (3 << 19)) >> 19) == 1 ? "OUT" : "IN");
wschon 1:2129bb91c172 681 hctd = hctd->nextTD;
wschon 1:2129bb91c172 682 }
wschon 1:2129bb91c172 683 printf("\thctd: %p\r\n", hctd);
wschon 1:2129bb91c172 684 hced = hced->nextED;
wschon 1:2129bb91c172 685 }
wschon 1:2129bb91c172 686 printf("\r\n\r\n");
wschon 1:2129bb91c172 687 #endif
wschon 1:2129bb91c172 688 }
wschon 1:2129bb91c172 689
wschon 1:2129bb91c172 690
wschon 1:2129bb91c172 691 // add a transfer on the TD linked list
wschon 1:2129bb91c172 692 USB_TYPE USBHost::addTransfer(USBEndpoint * ed, uint8_t * buf, uint32_t len)
wschon 1:2129bb91c172 693 {
wschon 1:2129bb91c172 694 td_mutex.lock();
wschon 1:2129bb91c172 695
wschon 1:2129bb91c172 696 // allocate a TD which will be freed in TDcompletion
wschon 1:2129bb91c172 697 volatile HCTD * td = ed->getNextTD();
wschon 1:2129bb91c172 698 if (td == NULL) {
wschon 1:2129bb91c172 699 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 700 }
wschon 1:2129bb91c172 701
wschon 1:2129bb91c172 702 uint32_t token = (ed->isSetup() ? TD_SETUP : ( (ed->getDir() == IN) ? TD_IN : TD_OUT ));
wschon 1:2129bb91c172 703
wschon 1:2129bb91c172 704 uint32_t td_toggle;
wschon 1:2129bb91c172 705
wschon 1:2129bb91c172 706 if (ed->getType() == CONTROL_ENDPOINT) {
wschon 1:2129bb91c172 707 if (ed->isSetup()) {
wschon 1:2129bb91c172 708 td_toggle = TD_TOGGLE_0;
wschon 1:2129bb91c172 709 } else {
wschon 1:2129bb91c172 710 td_toggle = TD_TOGGLE_1;
wschon 1:2129bb91c172 711 }
wschon 1:2129bb91c172 712 } else {
wschon 1:2129bb91c172 713 td_toggle = 0;
wschon 1:2129bb91c172 714 }
wschon 1:2129bb91c172 715
wschon 1:2129bb91c172 716 td->control = (TD_ROUNDING | token | TD_DELAY_INT(0) | td_toggle | TD_CC);
wschon 1:2129bb91c172 717 td->currBufPtr = buf;
wschon 1:2129bb91c172 718 td->bufEnd = (buf + (len - 1));
wschon 1:2129bb91c172 719
wschon 1:2129bb91c172 720 ENDPOINT_TYPE type = ed->getType();
wschon 1:2129bb91c172 721
wschon 1:2129bb91c172 722 disableList(type);
wschon 1:2129bb91c172 723 ed->queueTransfer();
wschon 1:2129bb91c172 724 printList(type);
wschon 1:2129bb91c172 725 enableList(type);
wschon 1:2129bb91c172 726
wschon 1:2129bb91c172 727 td_mutex.unlock();
wschon 1:2129bb91c172 728
wschon 1:2129bb91c172 729 return USB_TYPE_PROCESSING;
wschon 1:2129bb91c172 730 }
wschon 1:2129bb91c172 731
wschon 1:2129bb91c172 732
wschon 1:2129bb91c172 733
wschon 1:2129bb91c172 734 USB_TYPE USBHost::getDeviceDescriptor(USBDeviceConnected * dev, uint8_t * buf, uint16_t max_len_buf, uint16_t * len_dev_descr)
wschon 1:2129bb91c172 735 {
wschon 1:2129bb91c172 736 USB_TYPE t = controlRead( dev,
wschon 1:2129bb91c172 737 USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE,
wschon 1:2129bb91c172 738 GET_DESCRIPTOR,
wschon 1:2129bb91c172 739 (DEVICE_DESCRIPTOR << 8) | (0),
wschon 1:2129bb91c172 740 0, buf, MIN(DEVICE_DESCRIPTOR_LENGTH, max_len_buf));
wschon 1:2129bb91c172 741 if (len_dev_descr)
wschon 1:2129bb91c172 742 *len_dev_descr = MIN(DEVICE_DESCRIPTOR_LENGTH, max_len_buf);
wschon 1:2129bb91c172 743
wschon 1:2129bb91c172 744 return t;
wschon 1:2129bb91c172 745 }
wschon 1:2129bb91c172 746
wschon 1:2129bb91c172 747 USB_TYPE USBHost::getConfigurationDescriptor(USBDeviceConnected * dev, uint8_t * buf, uint16_t max_len_buf, uint16_t * len_conf_descr)
wschon 1:2129bb91c172 748 {
wschon 1:2129bb91c172 749 USB_TYPE res;
wschon 1:2129bb91c172 750 uint16_t total_conf_descr_length = 0;
wschon 1:2129bb91c172 751
wschon 1:2129bb91c172 752 // fourth step: get the beginning of the configuration descriptor to have the total length of the conf descr
wschon 1:2129bb91c172 753 res = controlRead( dev,
wschon 1:2129bb91c172 754 USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE,
wschon 1:2129bb91c172 755 GET_DESCRIPTOR,
wschon 1:2129bb91c172 756 (CONFIGURATION_DESCRIPTOR << 8) | (0),
wschon 1:2129bb91c172 757 0, buf, CONFIGURATION_DESCRIPTOR_LENGTH);
wschon 1:2129bb91c172 758
wschon 1:2129bb91c172 759 if (res != USB_TYPE_OK) {
wschon 1:2129bb91c172 760 USB_ERR("GET CONF 1 DESCR FAILED");
wschon 1:2129bb91c172 761 return res;
wschon 1:2129bb91c172 762 }
wschon 1:2129bb91c172 763 total_conf_descr_length = buf[2] | (buf[3] << 8);
wschon 1:2129bb91c172 764 total_conf_descr_length = MIN(max_len_buf, total_conf_descr_length);
wschon 1:2129bb91c172 765
wschon 1:2129bb91c172 766 if (len_conf_descr)
wschon 1:2129bb91c172 767 *len_conf_descr = total_conf_descr_length;
wschon 1:2129bb91c172 768
wschon 1:2129bb91c172 769 USB_DBG("TOTAL_LENGTH: %d \t NUM_INTERF: %d", total_conf_descr_length, buf[4]);
wschon 1:2129bb91c172 770
wschon 1:2129bb91c172 771 return controlRead( dev,
wschon 1:2129bb91c172 772 USB_DEVICE_TO_HOST | USB_RECIPIENT_DEVICE,
wschon 1:2129bb91c172 773 GET_DESCRIPTOR,
wschon 1:2129bb91c172 774 (CONFIGURATION_DESCRIPTOR << 8) | (0),
wschon 1:2129bb91c172 775 0, buf, total_conf_descr_length);
wschon 1:2129bb91c172 776 }
wschon 1:2129bb91c172 777
wschon 1:2129bb91c172 778
wschon 1:2129bb91c172 779 USB_TYPE USBHost::setAddress(USBDeviceConnected * dev, uint8_t address) {
wschon 1:2129bb91c172 780 return controlWrite( dev,
wschon 1:2129bb91c172 781 USB_HOST_TO_DEVICE | USB_RECIPIENT_DEVICE,
wschon 1:2129bb91c172 782 SET_ADDRESS,
wschon 1:2129bb91c172 783 address,
wschon 1:2129bb91c172 784 0, NULL, 0);
wschon 1:2129bb91c172 785
wschon 1:2129bb91c172 786 }
wschon 1:2129bb91c172 787
wschon 1:2129bb91c172 788 USB_TYPE USBHost::setConfiguration(USBDeviceConnected * dev, uint8_t conf)
wschon 1:2129bb91c172 789 {
wschon 1:2129bb91c172 790 return controlWrite( dev,
wschon 1:2129bb91c172 791 USB_HOST_TO_DEVICE | USB_RECIPIENT_DEVICE,
wschon 1:2129bb91c172 792 SET_CONFIGURATION,
wschon 1:2129bb91c172 793 conf,
wschon 1:2129bb91c172 794 0, NULL, 0);
wschon 1:2129bb91c172 795 }
wschon 1:2129bb91c172 796
wschon 1:2129bb91c172 797 uint8_t USBHost::numberDriverAttached(USBDeviceConnected * dev) {
wschon 1:2129bb91c172 798 int index = findDevice(dev);
wschon 1:2129bb91c172 799 uint8_t cnt = 0;
wschon 1:2129bb91c172 800 if (index == -1)
wschon 1:2129bb91c172 801 return 0;
wschon 1:2129bb91c172 802 for (uint8_t i = 0; i < MAX_INTF; i++) {
wschon 1:2129bb91c172 803 if (deviceAttachedDriver[index][i])
wschon 1:2129bb91c172 804 cnt++;
wschon 1:2129bb91c172 805 }
wschon 1:2129bb91c172 806 return cnt;
wschon 1:2129bb91c172 807 }
wschon 1:2129bb91c172 808
wschon 1:2129bb91c172 809 // enumerate a device with the control USBEndpoint
wschon 1:2129bb91c172 810 USB_TYPE USBHost::enumerate(USBDeviceConnected * dev, IUSBEnumerator* pEnumerator)
wschon 1:2129bb91c172 811 {
wschon 1:2129bb91c172 812 uint16_t total_conf_descr_length = 0;
wschon 1:2129bb91c172 813 USB_TYPE res;
wschon 1:2129bb91c172 814
wschon 1:2129bb91c172 815 usb_mutex.lock();
wschon 1:2129bb91c172 816
wschon 1:2129bb91c172 817 // don't enumerate a device which all interfaces are registered to a specific driver
wschon 1:2129bb91c172 818 int index = findDevice(dev);
wschon 1:2129bb91c172 819
wschon 1:2129bb91c172 820 if (index == -1) {
wschon 1:2129bb91c172 821 usb_mutex.unlock();
wschon 1:2129bb91c172 822 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 823 }
wschon 1:2129bb91c172 824
wschon 1:2129bb91c172 825 uint8_t nb_intf_attached = numberDriverAttached(dev);
wschon 1:2129bb91c172 826 USB_DBG("dev: %p nb_intf: %d", dev, dev->getNbIntf());
wschon 1:2129bb91c172 827 USB_DBG("dev: %p nb_intf_attached: %d", dev, nb_intf_attached);
wschon 1:2129bb91c172 828 if ((nb_intf_attached != 0) && (dev->getNbIntf() == nb_intf_attached)) {
wschon 1:2129bb91c172 829 USB_DBG("Don't enumerate dev: %p because all intf are registered with a driver", dev);
wschon 1:2129bb91c172 830 usb_mutex.unlock();
wschon 1:2129bb91c172 831 return USB_TYPE_OK;
wschon 1:2129bb91c172 832 }
wschon 1:2129bb91c172 833
wschon 1:2129bb91c172 834 USB_DBG("Enumerate dev: %p", dev);
wschon 1:2129bb91c172 835
wschon 1:2129bb91c172 836 // third step: get the whole device descriptor to see vid, pid
wschon 1:2129bb91c172 837 res = getDeviceDescriptor(dev, data, DEVICE_DESCRIPTOR_LENGTH);
wschon 1:2129bb91c172 838
wschon 1:2129bb91c172 839 if (res != USB_TYPE_OK) {
wschon 1:2129bb91c172 840 USB_DBG("GET DEV DESCR FAILED");
wschon 1:2129bb91c172 841 usb_mutex.unlock();
wschon 1:2129bb91c172 842 return res;
wschon 1:2129bb91c172 843 }
wschon 1:2129bb91c172 844
wschon 1:2129bb91c172 845 dev->setClass(data[4]);
wschon 1:2129bb91c172 846 dev->setSubClass(data[5]);
wschon 1:2129bb91c172 847 dev->setProtocol(data[6]);
wschon 1:2129bb91c172 848 dev->setVid(data[8] | (data[9] << 8));
wschon 1:2129bb91c172 849 dev->setPid(data[10] | (data[11] << 8));
wschon 1:2129bb91c172 850 USB_DBG("CLASS: %02X \t VID: %04X \t PID: %04X", data[4], data[8] | (data[9] << 8), data[10] | (data[11] << 8));
wschon 1:2129bb91c172 851
wschon 1:2129bb91c172 852 pEnumerator->setVidPid( data[8] | (data[9] << 8), data[10] | (data[11] << 8) );
wschon 1:2129bb91c172 853
wschon 1:2129bb91c172 854 res = getConfigurationDescriptor(dev, data, 400, &total_conf_descr_length);
wschon 1:2129bb91c172 855 if (res != USB_TYPE_OK) {
wschon 1:2129bb91c172 856 usb_mutex.unlock();
wschon 1:2129bb91c172 857 return res;
wschon 1:2129bb91c172 858 }
wschon 1:2129bb91c172 859
wschon 1:2129bb91c172 860 #if DEBUG
wschon 1:2129bb91c172 861 USB_DBG("CONFIGURATION DESCRIPTOR:\r\n");
wschon 1:2129bb91c172 862 for (int i = 0; i < total_conf_descr_length; i++)
wschon 1:2129bb91c172 863 printf("%02X ", data[i]);
wschon 1:2129bb91c172 864 printf("\r\n\r\n");
wschon 1:2129bb91c172 865 #endif
wschon 1:2129bb91c172 866
wschon 1:2129bb91c172 867 // Parse the configuration descriptor
wschon 1:2129bb91c172 868 parseConfDescr(dev, data, total_conf_descr_length, pEnumerator);
wschon 1:2129bb91c172 869
wschon 1:2129bb91c172 870 // only set configuration if not enumerated before
wschon 1:2129bb91c172 871 if (!dev->isEnumerated()) {
wschon 1:2129bb91c172 872
wschon 1:2129bb91c172 873 USB_DBG("Set configuration 1 on dev: %p", dev);
wschon 1:2129bb91c172 874 // sixth step: set configuration (only 1 supported)
wschon 1:2129bb91c172 875 res = setConfiguration(dev, 1);
wschon 1:2129bb91c172 876
wschon 1:2129bb91c172 877 if (res != USB_TYPE_OK) {
wschon 1:2129bb91c172 878 USB_DBG("SET CONF FAILED");
wschon 1:2129bb91c172 879 usb_mutex.unlock();
wschon 1:2129bb91c172 880 return res;
wschon 1:2129bb91c172 881 }
wschon 1:2129bb91c172 882 }
wschon 1:2129bb91c172 883
wschon 1:2129bb91c172 884 dev->setEnumerated();
wschon 1:2129bb91c172 885
wschon 1:2129bb91c172 886 // Now the device is enumerated!
wschon 1:2129bb91c172 887 USB_DBG("dev %p is enumerated\r\n", dev);
wschon 1:2129bb91c172 888 usb_mutex.unlock();
wschon 1:2129bb91c172 889
wschon 1:2129bb91c172 890 // Some devices may require this delay
wschon 1:2129bb91c172 891 wait_ms(100);
wschon 1:2129bb91c172 892
wschon 1:2129bb91c172 893 return USB_TYPE_OK;
wschon 1:2129bb91c172 894 }
wschon 1:2129bb91c172 895 // this method fills the USBDeviceConnected object: class,.... . It also add endpoints found in the descriptor.
wschon 1:2129bb91c172 896 void USBHost::parseConfDescr(USBDeviceConnected * dev, uint8_t * conf_descr, uint32_t len, IUSBEnumerator* pEnumerator)
wschon 1:2129bb91c172 897 {
wschon 1:2129bb91c172 898 uint32_t index = 0;
wschon 1:2129bb91c172 899 uint32_t len_desc = 0;
wschon 1:2129bb91c172 900 uint8_t id = 0;
wschon 1:2129bb91c172 901 int nb_endpoints_used = 0;
wschon 1:2129bb91c172 902 USBEndpoint * ep = NULL;
wschon 1:2129bb91c172 903 uint8_t intf_nb = 0;
wschon 1:2129bb91c172 904 bool parsing_intf = false;
wschon 1:2129bb91c172 905 uint8_t current_intf = 0;
wschon 1:2129bb91c172 906
wschon 1:2129bb91c172 907 while (index < len) {
wschon 1:2129bb91c172 908 len_desc = conf_descr[index];
wschon 1:2129bb91c172 909 id = conf_descr[index+1];
wschon 1:2129bb91c172 910 switch (id) {
wschon 1:2129bb91c172 911 case CONFIGURATION_DESCRIPTOR:
wschon 1:2129bb91c172 912 USB_DBG("dev: %p has %d intf", dev, conf_descr[4]);
wschon 1:2129bb91c172 913 dev->setNbIntf(conf_descr[4]);
wschon 1:2129bb91c172 914 break;
wschon 1:2129bb91c172 915 case INTERFACE_DESCRIPTOR:
wschon 1:2129bb91c172 916 if(pEnumerator->parseInterface(conf_descr[index + 2], conf_descr[index + 5], conf_descr[index + 6], conf_descr[index + 7])) {
wschon 1:2129bb91c172 917 if (intf_nb++ <= MAX_INTF) {
wschon 1:2129bb91c172 918 current_intf = conf_descr[index + 2];
wschon 1:2129bb91c172 919 dev->addInterface(current_intf, conf_descr[index + 5], conf_descr[index + 6], conf_descr[index + 7]);
wschon 1:2129bb91c172 920 nb_endpoints_used = 0;
wschon 1:2129bb91c172 921 USB_DBG("ADD INTF %d on device %p: class: %d, subclass: %d, proto: %d", current_intf, dev, conf_descr[index + 5],conf_descr[index + 6],conf_descr[index + 7]);
wschon 1:2129bb91c172 922 } else {
wschon 1:2129bb91c172 923 USB_DBG("Drop intf...");
wschon 1:2129bb91c172 924 }
wschon 1:2129bb91c172 925 parsing_intf = true;
wschon 1:2129bb91c172 926 } else {
wschon 1:2129bb91c172 927 parsing_intf = false;
wschon 1:2129bb91c172 928 }
wschon 1:2129bb91c172 929 break;
wschon 1:2129bb91c172 930 case ENDPOINT_DESCRIPTOR:
wschon 1:2129bb91c172 931 if (parsing_intf && (intf_nb <= MAX_INTF) ) {
wschon 1:2129bb91c172 932 if (nb_endpoints_used < MAX_ENDPOINT_PER_INTERFACE) {
wschon 1:2129bb91c172 933 if( pEnumerator->useEndpoint(current_intf, (ENDPOINT_TYPE)(conf_descr[index + 3] & 0x03), (ENDPOINT_DIRECTION)((conf_descr[index + 2] >> 7) + 1)) ) {
wschon 1:2129bb91c172 934 // if the USBEndpoint is isochronous -> skip it (TODO: fix this)
wschon 1:2129bb91c172 935 if ((conf_descr[index + 3] & 0x03) != ISOCHRONOUS_ENDPOINT) {
wschon 1:2129bb91c172 936 ep = newEndpoint((ENDPOINT_TYPE)(conf_descr[index+3] & 0x03),
wschon 1:2129bb91c172 937 (ENDPOINT_DIRECTION)((conf_descr[index + 2] >> 7) + 1),
wschon 1:2129bb91c172 938 conf_descr[index + 4] | (conf_descr[index + 5] << 8),
wschon 1:2129bb91c172 939 conf_descr[index + 2] & 0x0f);
wschon 1:2129bb91c172 940 USB_DBG("ADD USBEndpoint %p, on interf %d on device %p", ep, current_intf, dev);
wschon 1:2129bb91c172 941 if (ep != NULL && dev != NULL) {
wschon 1:2129bb91c172 942 addEndpoint(dev, current_intf, ep);
wschon 1:2129bb91c172 943 } else {
wschon 1:2129bb91c172 944 USB_DBG("EP NULL");
wschon 1:2129bb91c172 945 }
wschon 1:2129bb91c172 946 nb_endpoints_used++;
wschon 1:2129bb91c172 947 } else {
wschon 1:2129bb91c172 948 USB_DBG("ISO USBEndpoint NOT SUPPORTED");
wschon 1:2129bb91c172 949 }
wschon 1:2129bb91c172 950 }
wschon 1:2129bb91c172 951 }
wschon 1:2129bb91c172 952 }
wschon 1:2129bb91c172 953 break;
wschon 1:2129bb91c172 954 case HID_DESCRIPTOR:
wschon 1:2129bb91c172 955 lenReportDescr = conf_descr[index + 7] | (conf_descr[index + 8] << 8);
wschon 1:2129bb91c172 956 break;
wschon 1:2129bb91c172 957 default:
wschon 1:2129bb91c172 958 break;
wschon 1:2129bb91c172 959 }
wschon 1:2129bb91c172 960 index += len_desc;
wschon 1:2129bb91c172 961 }
wschon 1:2129bb91c172 962 }
wschon 1:2129bb91c172 963
wschon 1:2129bb91c172 964
wschon 1:2129bb91c172 965 USB_TYPE USBHost::bulkWrite(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking)
wschon 1:2129bb91c172 966 {
wschon 1:2129bb91c172 967 return generalTransfer(dev, ep, buf, len, blocking, BULK_ENDPOINT, true);
wschon 1:2129bb91c172 968 }
wschon 1:2129bb91c172 969
wschon 1:2129bb91c172 970 USB_TYPE USBHost::bulkRead(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking)
wschon 1:2129bb91c172 971 {
wschon 1:2129bb91c172 972 return generalTransfer(dev, ep, buf, len, blocking, BULK_ENDPOINT, false);
wschon 1:2129bb91c172 973 }
wschon 1:2129bb91c172 974
wschon 1:2129bb91c172 975 USB_TYPE USBHost::interruptWrite(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking)
wschon 1:2129bb91c172 976 {
wschon 1:2129bb91c172 977 return generalTransfer(dev, ep, buf, len, blocking, INTERRUPT_ENDPOINT, true);
wschon 1:2129bb91c172 978 }
wschon 1:2129bb91c172 979
wschon 1:2129bb91c172 980 USB_TYPE USBHost::interruptRead(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking)
wschon 1:2129bb91c172 981 {
wschon 1:2129bb91c172 982 return generalTransfer(dev, ep, buf, len, blocking, INTERRUPT_ENDPOINT, false);
wschon 1:2129bb91c172 983 }
wschon 1:2129bb91c172 984
wschon 1:2129bb91c172 985 USB_TYPE USBHost::generalTransfer(USBDeviceConnected * dev, USBEndpoint * ep, uint8_t * buf, uint32_t len, bool blocking, ENDPOINT_TYPE type, bool write) {
wschon 1:2129bb91c172 986
wschon 1:2129bb91c172 987 #if DEBUG_TRANSFER
wschon 1:2129bb91c172 988 const char * type_str = (type == BULK_ENDPOINT) ? "BULK" : ((type == INTERRUPT_ENDPOINT) ? "INTERRUPT" : "ISOCHRONOUS");
wschon 1:2129bb91c172 989 USB_DBG_TRANSFER("----- %s %s [dev: %p - %s - hub: %d - port: %d - addr: %d - ep: %02X]------", type_str, (write) ? "WRITE" : "READ", dev, dev->getName(ep->getIntfNb()), dev->getHub(), dev->getPort(), dev->getAddress(), ep->getAddress());
wschon 1:2129bb91c172 990 #endif
wschon 1:2129bb91c172 991
wschon 1:2129bb91c172 992 usb_mutex.lock();
wschon 1:2129bb91c172 993
wschon 1:2129bb91c172 994 USB_TYPE res;
wschon 1:2129bb91c172 995 ENDPOINT_DIRECTION dir = (write) ? OUT : IN;
wschon 1:2129bb91c172 996
wschon 1:2129bb91c172 997 if (dev == NULL) {
wschon 1:2129bb91c172 998 USB_ERR("dev NULL");
wschon 1:2129bb91c172 999 usb_mutex.unlock();
wschon 1:2129bb91c172 1000 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 1001 }
wschon 1:2129bb91c172 1002
wschon 1:2129bb91c172 1003 if (ep == NULL) {
wschon 1:2129bb91c172 1004 USB_ERR("ep NULL");
wschon 1:2129bb91c172 1005 usb_mutex.unlock();
wschon 1:2129bb91c172 1006 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 1007 }
wschon 1:2129bb91c172 1008
wschon 1:2129bb91c172 1009 if (ep->getState() != USB_TYPE_IDLE) {
wschon 1:2129bb91c172 1010 USB_WARN("[ep: %p - dev: %p - %s] NOT IDLE: %s", ep, ep->dev, ep->dev->getName(ep->getIntfNb()), ep->getStateString());
wschon 1:2129bb91c172 1011 usb_mutex.unlock();
wschon 1:2129bb91c172 1012 return ep->getState();
wschon 1:2129bb91c172 1013 }
wschon 1:2129bb91c172 1014
wschon 1:2129bb91c172 1015 if ((ep->getDir() != dir) || (ep->getType() != type)) {
wschon 1:2129bb91c172 1016 USB_ERR("[ep: %p - dev: %p] wrong dir or bad USBEndpoint type", ep, ep->dev);
wschon 1:2129bb91c172 1017 usb_mutex.unlock();
wschon 1:2129bb91c172 1018 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 1019 }
wschon 1:2129bb91c172 1020
wschon 1:2129bb91c172 1021 if (dev->getAddress() != ep->getDeviceAddress()) {
wschon 1:2129bb91c172 1022 USB_ERR("[ep: %p - dev: %p] USBEndpoint addr and device addr don't match", ep, ep->dev);
wschon 1:2129bb91c172 1023 usb_mutex.unlock();
wschon 1:2129bb91c172 1024 return USB_TYPE_ERROR;
wschon 1:2129bb91c172 1025 }
wschon 1:2129bb91c172 1026
wschon 1:2129bb91c172 1027 #if DEBUG_TRANSFER
wschon 1:2129bb91c172 1028 if (write) {
wschon 1:2129bb91c172 1029 USB_DBG_TRANSFER("%s WRITE buffer", type_str);
wschon 1:2129bb91c172 1030 for (int i = 0; i < ep->getLengthTransferred(); i++)
wschon 1:2129bb91c172 1031 printf("%02X ", buf[i]);
wschon 1:2129bb91c172 1032 printf("\r\n\r\n");
wschon 1:2129bb91c172 1033 }
wschon 1:2129bb91c172 1034 #endif
wschon 1:2129bb91c172 1035 addTransfer(ep, buf, len);
wschon 1:2129bb91c172 1036
wschon 1:2129bb91c172 1037 if (blocking) {
wschon 1:2129bb91c172 1038
wschon 1:2129bb91c172 1039 ep->ep_queue.get();
wschon 1:2129bb91c172 1040 res = ep->getState();
wschon 1:2129bb91c172 1041
wschon 1:2129bb91c172 1042 USB_DBG_TRANSFER("%s TRANSFER res: %s on ep: %p\r\n", type_str, ep->getStateString(), ep);
wschon 1:2129bb91c172 1043
wschon 1:2129bb91c172 1044 if (res != USB_TYPE_IDLE) {
wschon 1:2129bb91c172 1045 usb_mutex.unlock();
wschon 1:2129bb91c172 1046 return res;
wschon 1:2129bb91c172 1047 }
wschon 1:2129bb91c172 1048
wschon 1:2129bb91c172 1049 usb_mutex.unlock();
wschon 1:2129bb91c172 1050 return USB_TYPE_OK;
wschon 1:2129bb91c172 1051 }
wschon 1:2129bb91c172 1052
wschon 1:2129bb91c172 1053 usb_mutex.unlock();
wschon 1:2129bb91c172 1054 return USB_TYPE_PROCESSING;
wschon 1:2129bb91c172 1055
wschon 1:2129bb91c172 1056 }
wschon 1:2129bb91c172 1057
wschon 1:2129bb91c172 1058
wschon 1:2129bb91c172 1059 USB_TYPE USBHost::controlRead(USBDeviceConnected * dev, uint8_t requestType, uint8_t request, uint32_t value, uint32_t index, uint8_t * buf, uint32_t len) {
wschon 1:2129bb91c172 1060 return controlTransfer(dev, requestType, request, value, index, buf, len, false);
wschon 1:2129bb91c172 1061 }
wschon 1:2129bb91c172 1062
wschon 1:2129bb91c172 1063 USB_TYPE USBHost::controlWrite(USBDeviceConnected * dev, uint8_t requestType, uint8_t request, uint32_t value, uint32_t index, uint8_t * buf, uint32_t len) {
wschon 1:2129bb91c172 1064 return controlTransfer(dev, requestType, request, value, index, buf, len, true);
wschon 1:2129bb91c172 1065 }
wschon 1:2129bb91c172 1066
wschon 1:2129bb91c172 1067 USB_TYPE USBHost::controlTransfer(USBDeviceConnected * dev, uint8_t requestType, uint8_t request, uint32_t value, uint32_t index, uint8_t * buf, uint32_t len, bool write)
wschon 1:2129bb91c172 1068 {
wschon 1:2129bb91c172 1069 usb_mutex.lock();
wschon 1:2129bb91c172 1070 USB_DBG_TRANSFER("----- CONTROL %s [dev: %p - hub: %d - port: %d] ------", (write) ? "WRITE" : "READ", dev, dev->getHub(), dev->getPort());
wschon 1:2129bb91c172 1071
wschon 1:2129bb91c172 1072 int length_transfer = len;
wschon 1:2129bb91c172 1073 USB_TYPE res;
wschon 1:2129bb91c172 1074 uint32_t token;
wschon 1:2129bb91c172 1075
wschon 1:2129bb91c172 1076 control->setSpeed(dev->getSpeed());
wschon 1:2129bb91c172 1077 control->setSize(dev->getSizeControlEndpoint());
wschon 1:2129bb91c172 1078 if (dev->isActiveAddress()) {
wschon 1:2129bb91c172 1079 control->setDeviceAddress(dev->getAddress());
wschon 1:2129bb91c172 1080 } else {
wschon 1:2129bb91c172 1081 control->setDeviceAddress(0);
wschon 1:2129bb91c172 1082 }
wschon 1:2129bb91c172 1083
wschon 1:2129bb91c172 1084 USB_DBG_TRANSFER("Control transfer on device: %d\r\n", control->getDeviceAddress());
wschon 1:2129bb91c172 1085 fillControlBuf(requestType, request, value, index, len);
wschon 1:2129bb91c172 1086
wschon 1:2129bb91c172 1087 #if DEBUG_TRANSFER
wschon 1:2129bb91c172 1088 USB_DBG_TRANSFER("SETUP PACKET: ");
wschon 1:2129bb91c172 1089 for (int i = 0; i < 8; i++)
wschon 1:2129bb91c172 1090 printf("%01X ", setupPacket[i]);
wschon 1:2129bb91c172 1091 printf("\r\n");
wschon 1:2129bb91c172 1092 #endif
wschon 1:2129bb91c172 1093
wschon 1:2129bb91c172 1094 control->setNextToken(TD_SETUP);
wschon 1:2129bb91c172 1095 addTransfer(control, (uint8_t*)setupPacket, 8);
wschon 1:2129bb91c172 1096
wschon 1:2129bb91c172 1097 control->ep_queue.get();
wschon 1:2129bb91c172 1098 res = control->getState();
wschon 1:2129bb91c172 1099
wschon 1:2129bb91c172 1100 USB_DBG_TRANSFER("CONTROL setup stage %s", control->getStateString());
wschon 1:2129bb91c172 1101
wschon 1:2129bb91c172 1102 if (res != USB_TYPE_IDLE) {
wschon 1:2129bb91c172 1103 usb_mutex.unlock();
wschon 1:2129bb91c172 1104 return res;
wschon 1:2129bb91c172 1105 }
wschon 1:2129bb91c172 1106
wschon 1:2129bb91c172 1107 if (length_transfer) {
wschon 1:2129bb91c172 1108 token = (write) ? TD_OUT : TD_IN;
wschon 1:2129bb91c172 1109 control->setNextToken(token);
wschon 1:2129bb91c172 1110 addTransfer(control, (uint8_t *)buf, length_transfer);
wschon 1:2129bb91c172 1111
wschon 1:2129bb91c172 1112 control->ep_queue.get();
wschon 1:2129bb91c172 1113 res = control->getState();
wschon 1:2129bb91c172 1114
wschon 1:2129bb91c172 1115 #if DEBUG_TRANSFER
wschon 1:2129bb91c172 1116 USB_DBG_TRANSFER("CONTROL %s stage %s", (write) ? "WRITE" : "READ", control->getStateString());
wschon 1:2129bb91c172 1117 if (write) {
wschon 1:2129bb91c172 1118 USB_DBG_TRANSFER("CONTROL WRITE buffer");
wschon 1:2129bb91c172 1119 for (int i = 0; i < control->getLengthTransferred(); i++)
wschon 1:2129bb91c172 1120 printf("%02X ", buf[i]);
wschon 1:2129bb91c172 1121 printf("\r\n\r\n");
wschon 1:2129bb91c172 1122 } else {
wschon 1:2129bb91c172 1123 USB_DBG_TRANSFER("CONTROL READ SUCCESS [%d bytes transferred]", control->getLengthTransferred());
wschon 1:2129bb91c172 1124 for (int i = 0; i < control->getLengthTransferred(); i++)
wschon 1:2129bb91c172 1125 printf("%02X ", buf[i]);
wschon 1:2129bb91c172 1126 printf("\r\n\r\n");
wschon 1:2129bb91c172 1127 }
wschon 1:2129bb91c172 1128 #endif
wschon 1:2129bb91c172 1129
wschon 1:2129bb91c172 1130 if (res != USB_TYPE_IDLE) {
wschon 1:2129bb91c172 1131 usb_mutex.unlock();
wschon 1:2129bb91c172 1132 return res;
wschon 1:2129bb91c172 1133 }
wschon 1:2129bb91c172 1134 }
wschon 1:2129bb91c172 1135
wschon 1:2129bb91c172 1136 token = (write) ? TD_IN : TD_OUT;
wschon 1:2129bb91c172 1137 control->setNextToken(token);
wschon 1:2129bb91c172 1138 addTransfer(control, NULL, 0);
wschon 1:2129bb91c172 1139
wschon 1:2129bb91c172 1140 control->ep_queue.get();
wschon 1:2129bb91c172 1141 res = control->getState();
wschon 1:2129bb91c172 1142
wschon 1:2129bb91c172 1143 USB_DBG_TRANSFER("CONTROL ack stage %s", control->getStateString());
wschon 1:2129bb91c172 1144 usb_mutex.unlock();
wschon 1:2129bb91c172 1145
wschon 1:2129bb91c172 1146 if (res != USB_TYPE_IDLE)
wschon 1:2129bb91c172 1147 return res;
wschon 1:2129bb91c172 1148
wschon 1:2129bb91c172 1149 return USB_TYPE_OK;
wschon 1:2129bb91c172 1150 }
wschon 1:2129bb91c172 1151
wschon 1:2129bb91c172 1152
wschon 1:2129bb91c172 1153 void USBHost::fillControlBuf(uint8_t requestType, uint8_t request, uint16_t value, uint16_t index, int len)
wschon 1:2129bb91c172 1154 {
wschon 1:2129bb91c172 1155 #ifdef __BIG_ENDIAN
wschon 1:2129bb91c172 1156 #error "Must implement BE to LE conv here"
wschon 1:2129bb91c172 1157 #endif
wschon 1:2129bb91c172 1158 setupPacket[0] = requestType;
wschon 1:2129bb91c172 1159 setupPacket[1] = request;
wschon 1:2129bb91c172 1160 //We are in LE so it's fine
wschon 1:2129bb91c172 1161 *((uint16_t*)&setupPacket[2]) = value;
wschon 1:2129bb91c172 1162 *((uint16_t*)&setupPacket[4]) = index;
wschon 1:2129bb91c172 1163 *((uint16_t*)&setupPacket[6]) = (uint32_t) len;
wschon 1:2129bb91c172 1164 }