z ysaito / USBHost3

2018.07.26

Dependencies:   FATFileSystem3 mbed-rtos

Fork of USBHost by mbed official

USBHost/USBHost.cpp@43:1675750cca08, 2018-07-26 (annotated)

Committer:
sayzyas
Date:
Thu Jul 26 00:20:32 2018 +0000
Revision:
43:1675750cca08
2018.07.26

Who changed what in which revision?

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