Geir Inge Tellnes / STM32_USBDevice

Fork of https://developer.mbed.org/users/bscott/code/STM32_USBDevice/

Fork of STM32_USBDevice by Bradley Scott

USBDevice/USBDevice.cpp@73:fa395f2d24ba, 2017-10-24 (annotated)

Committer:
Geir Inge Tellnes
Date:
Tue Oct 24 12:32:59 2017 +0200
Revision:
73:fa395f2d24ba
Parent:
43:c0605f23f916
Child:
74:8e2832c1046a
Added possibility to configure a USB_DEVICE_WRITE_BLOCKING_TIMEOUT_MS in blocking write method

Who changed what in which revision?

UserRevisionLine numberNew contents of line
samux 1:80ab0d068708 1 /* Copyright (c) 2010-2011 mbed.org, MIT License
samux 1:80ab0d068708 2 *
samux 1:80ab0d068708 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
samux 1:80ab0d068708 4 * and associated documentation files (the "Software"), to deal in the Software without
samux 1:80ab0d068708 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
samux 1:80ab0d068708 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
samux 1:80ab0d068708 7 * Software is furnished to do so, subject to the following conditions:
samux 1:80ab0d068708 8 *
samux 1:80ab0d068708 9 * The above copyright notice and this permission notice shall be included in all copies or
samux 1:80ab0d068708 10 * substantial portions of the Software.
samux 1:80ab0d068708 11 *
samux 1:80ab0d068708 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
samux 1:80ab0d068708 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
samux 1:80ab0d068708 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
samux 1:80ab0d068708 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
samux 1:80ab0d068708 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
samux 1:80ab0d068708 17 */
samux 1:80ab0d068708 18
samux 1:80ab0d068708 19 #include "stdint.h"
samux 1:80ab0d068708 20
samux 1:80ab0d068708 21 #include "USBEndpoints.h"
samux 1:80ab0d068708 22 #include "USBDevice.h"
samux 1:80ab0d068708 23 #include "USBDescriptor.h"
samux 1:80ab0d068708 24
samux 1:80ab0d068708 25 //#define DEBUG
samux 1:80ab0d068708 26
samux 1:80ab0d068708 27 /* Device status */
samux 1:80ab0d068708 28 #define DEVICE_STATUS_SELF_POWERED (1U<<0)
samux 1:80ab0d068708 29 #define DEVICE_STATUS_REMOTE_WAKEUP (1U<<1)
samux 1:80ab0d068708 30
samux 1:80ab0d068708 31 /* Endpoint status */
samux 1:80ab0d068708 32 #define ENDPOINT_STATUS_HALT (1U<<0)
samux 1:80ab0d068708 33
samux 1:80ab0d068708 34 /* Standard feature selectors */
samux 1:80ab0d068708 35 #define DEVICE_REMOTE_WAKEUP (1)
samux 1:80ab0d068708 36 #define ENDPOINT_HALT (0)
samux 1:80ab0d068708 37
samux 1:80ab0d068708 38 /* Macro to convert wIndex endpoint number to physical endpoint number */
samux 1:80ab0d068708 39 #define WINDEX_TO_PHYSICAL(endpoint) (((endpoint & 0x0f) << 1) + \
samux 1:80ab0d068708 40 ((endpoint & 0x80) ? 1 : 0))
samux 1:80ab0d068708 41
samux 1:80ab0d068708 42
samux 1:80ab0d068708 43 bool USBDevice::requestGetDescriptor(void)
samux 1:80ab0d068708 44 {
samux 1:80ab0d068708 45 bool success = false;
samux 1:80ab0d068708 46 #ifdef DEBUG
samux 1:80ab0d068708 47 printf("get descr: type: %d\r\n", DESCRIPTOR_TYPE(transfer.setup.wValue));
samux 1:80ab0d068708 48 #endif
samux 1:80ab0d068708 49 switch (DESCRIPTOR_TYPE(transfer.setup.wValue))
samux 1:80ab0d068708 50 {
samux 1:80ab0d068708 51 case DEVICE_DESCRIPTOR:
samux 1:80ab0d068708 52 if (deviceDesc() != NULL)
samux 1:80ab0d068708 53 {
samux 1:80ab0d068708 54 if ((deviceDesc()[0] == DEVICE_DESCRIPTOR_LENGTH) \
samux 1:80ab0d068708 55 && (deviceDesc()[1] == DEVICE_DESCRIPTOR))
samux 1:80ab0d068708 56 {
samux 1:80ab0d068708 57 #ifdef DEBUG
samux 1:80ab0d068708 58 printf("device descr\r\n");
samux 1:80ab0d068708 59 #endif
samux 1:80ab0d068708 60 transfer.remaining = DEVICE_DESCRIPTOR_LENGTH;
samux 1:80ab0d068708 61 transfer.ptr = deviceDesc();
samux 1:80ab0d068708 62 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 63 success = true;
samux 1:80ab0d068708 64 }
samux 1:80ab0d068708 65 }
samux 1:80ab0d068708 66 break;
samux 1:80ab0d068708 67 case CONFIGURATION_DESCRIPTOR:
samux 1:80ab0d068708 68 if (configurationDesc() != NULL)
samux 1:80ab0d068708 69 {
samux 1:80ab0d068708 70 if ((configurationDesc()[0] == CONFIGURATION_DESCRIPTOR_LENGTH) \
samux 1:80ab0d068708 71 && (configurationDesc()[1] == CONFIGURATION_DESCRIPTOR))
samux 1:80ab0d068708 72 {
samux 1:80ab0d068708 73 #ifdef DEBUG
samux 1:80ab0d068708 74 printf("conf descr request\r\n");
samux 1:80ab0d068708 75 #endif
samux 1:80ab0d068708 76 /* Get wTotalLength */
samux 1:80ab0d068708 77 transfer.remaining = configurationDesc()[2] \
samux 1:80ab0d068708 78 | (configurationDesc()[3] << 8);
samux 1:80ab0d068708 79
samux 1:80ab0d068708 80 transfer.ptr = configurationDesc();
samux 1:80ab0d068708 81 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 82 success = true;
samux 1:80ab0d068708 83 }
samux 1:80ab0d068708 84 }
samux 1:80ab0d068708 85 break;
samux 1:80ab0d068708 86 case STRING_DESCRIPTOR:
samux 1:80ab0d068708 87 #ifdef DEBUG
samux 1:80ab0d068708 88 printf("str descriptor\r\n");
samux 1:80ab0d068708 89 #endif
samux 1:80ab0d068708 90 switch (DESCRIPTOR_INDEX(transfer.setup.wValue))
samux 1:80ab0d068708 91 {
samux 1:80ab0d068708 92 case STRING_OFFSET_LANGID:
samux 1:80ab0d068708 93 #ifdef DEBUG
samux 1:80ab0d068708 94 printf("1\r\n");
samux 1:80ab0d068708 95 #endif
samux 1:80ab0d068708 96 transfer.remaining = stringLangidDesc()[0];
samux 1:80ab0d068708 97 transfer.ptr = stringLangidDesc();
samux 1:80ab0d068708 98 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 99 success = true;
samux 1:80ab0d068708 100 break;
samux 1:80ab0d068708 101 case STRING_OFFSET_IMANUFACTURER:
samux 1:80ab0d068708 102 #ifdef DEBUG
samux 1:80ab0d068708 103 printf("2\r\n");
samux 1:80ab0d068708 104 #endif
samux 1:80ab0d068708 105 transfer.remaining = stringImanufacturerDesc()[0];
samux 1:80ab0d068708 106 transfer.ptr = stringImanufacturerDesc();
samux 1:80ab0d068708 107 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 108 success = true;
mbed_official 25:7c72828865f3 109 break;
samux 1:80ab0d068708 110 case STRING_OFFSET_IPRODUCT:
samux 1:80ab0d068708 111 #ifdef DEBUG
samux 1:80ab0d068708 112 printf("3\r\n");
samux 1:80ab0d068708 113 #endif
samux 1:80ab0d068708 114 transfer.remaining = stringIproductDesc()[0];
samux 1:80ab0d068708 115 transfer.ptr = stringIproductDesc();
samux 1:80ab0d068708 116 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 117 success = true;
mbed_official 25:7c72828865f3 118 break;
samux 1:80ab0d068708 119 case STRING_OFFSET_ISERIAL:
samux 1:80ab0d068708 120 #ifdef DEBUG
samux 1:80ab0d068708 121 printf("4\r\n");
samux 1:80ab0d068708 122 #endif
samux 1:80ab0d068708 123 transfer.remaining = stringIserialDesc()[0];
samux 1:80ab0d068708 124 transfer.ptr = stringIserialDesc();
samux 1:80ab0d068708 125 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 126 success = true;
mbed_official 25:7c72828865f3 127 break;
samux 1:80ab0d068708 128 case STRING_OFFSET_ICONFIGURATION:
samux 1:80ab0d068708 129 #ifdef DEBUG
samux 1:80ab0d068708 130 printf("5\r\n");
samux 1:80ab0d068708 131 #endif
samux 1:80ab0d068708 132 transfer.remaining = stringIConfigurationDesc()[0];
samux 1:80ab0d068708 133 transfer.ptr = stringIConfigurationDesc();
samux 1:80ab0d068708 134 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 135 success = true;
mbed_official 25:7c72828865f3 136 break;
samux 1:80ab0d068708 137 case STRING_OFFSET_IINTERFACE:
samux 1:80ab0d068708 138 #ifdef DEBUG
samux 1:80ab0d068708 139 printf("6\r\n");
samux 1:80ab0d068708 140 #endif
samux 1:80ab0d068708 141 transfer.remaining = stringIinterfaceDesc()[0];
samux 1:80ab0d068708 142 transfer.ptr = stringIinterfaceDesc();
samux 1:80ab0d068708 143 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 144 success = true;
mbed_official 25:7c72828865f3 145 break;
samux 1:80ab0d068708 146 }
samux 1:80ab0d068708 147 break;
samux 1:80ab0d068708 148 case INTERFACE_DESCRIPTOR:
samux 1:80ab0d068708 149 #ifdef DEBUG
samux 1:80ab0d068708 150 printf("interface descr\r\n");
samux 1:80ab0d068708 151 #endif
samux 1:80ab0d068708 152 case ENDPOINT_DESCRIPTOR:
samux 1:80ab0d068708 153 #ifdef DEBUG
samux 1:80ab0d068708 154 printf("endpoint descr\r\n");
samux 1:80ab0d068708 155 #endif
samux 1:80ab0d068708 156 /* TODO: Support is optional, not implemented here */
samux 1:80ab0d068708 157 break;
samux 1:80ab0d068708 158 default:
samux 1:80ab0d068708 159 #ifdef DEBUG
samux 1:80ab0d068708 160 printf("ERROR\r\n");
samux 1:80ab0d068708 161 #endif
samux 1:80ab0d068708 162 break;
samux 1:80ab0d068708 163 }
samux 1:80ab0d068708 164
samux 1:80ab0d068708 165 return success;
samux 1:80ab0d068708 166 }
samux 1:80ab0d068708 167
samux 1:80ab0d068708 168 void USBDevice::decodeSetupPacket(uint8_t *data, SETUP_PACKET *packet)
samux 1:80ab0d068708 169 {
samux 1:80ab0d068708 170 /* Fill in the elements of a SETUP_PACKET structure from raw data */
samux 1:80ab0d068708 171 packet->bmRequestType.dataTransferDirection = (data[0] & 0x80) >> 7;
samux 1:80ab0d068708 172 packet->bmRequestType.Type = (data[0] & 0x60) >> 5;
samux 1:80ab0d068708 173 packet->bmRequestType.Recipient = data[0] & 0x1f;
samux 1:80ab0d068708 174 packet->bRequest = data[1];
samux 1:80ab0d068708 175 packet->wValue = (data[2] | (uint16_t)data[3] << 8);
samux 1:80ab0d068708 176 packet->wIndex = (data[4] | (uint16_t)data[5] << 8);
samux 1:80ab0d068708 177 packet->wLength = (data[6] | (uint16_t)data[7] << 8);
samux 1:80ab0d068708 178 }
samux 1:80ab0d068708 179
samux 1:80ab0d068708 180
samux 1:80ab0d068708 181 bool USBDevice::controlOut(void)
samux 1:80ab0d068708 182 {
samux 1:80ab0d068708 183 /* Control transfer data OUT stage */
samux 1:80ab0d068708 184 uint8_t buffer[MAX_PACKET_SIZE_EP0];
samux 1:80ab0d068708 185 uint32_t packetSize;
samux 1:80ab0d068708 186
samux 1:80ab0d068708 187 /* Check we should be transferring data OUT */
samux 1:80ab0d068708 188 if (transfer.direction != HOST_TO_DEVICE)
samux 1:80ab0d068708 189 {
mbed_official 43:c0605f23f916 190 #if defined(TARGET_KL25Z) | defined(TARGET_KL43Z) | defined(TARGET_KL46Z) | defined(TARGET_K20D5M) | defined(TARGET_K64F) | defined(TARGET_K22F) | defined(TARGET_TEENSY3_1)
mbed_official 28:c09a0c9bf425 191 /*
mbed_official 28:c09a0c9bf425 192 * We seem to have a pending device-to-host transfer. The host must have
mbed_official 28:c09a0c9bf425 193 * sent a new control request without waiting for us to finish processing
Geir Inge Tellnes 73:fa395f2d24ba 194 * the previous one. This appears to happen when we're connected to certain
mbed_official 28:c09a0c9bf425 195 * USB 3.0 host chip set. Do a zeor-length send to tell the host we're not
mbed_official 28:c09a0c9bf425 196 * ready for the new request - that'll make it resend - and then just
mbed_official 28:c09a0c9bf425 197 * pretend we were successful here so that the pending transfer can finish.
mbed_official 28:c09a0c9bf425 198 */
mbed_official 28:c09a0c9bf425 199 uint8_t buf[1] = { 0 };
mbed_official 28:c09a0c9bf425 200 EP0write(buf, 0);
Geir Inge Tellnes 73:fa395f2d24ba 201
mbed_official 28:c09a0c9bf425 202 /* execute our pending ttransfer */
mbed_official 28:c09a0c9bf425 203 controlIn();
Geir Inge Tellnes 73:fa395f2d24ba 204
mbed_official 28:c09a0c9bf425 205 /* indicate success */
mbed_official 28:c09a0c9bf425 206 return true;
mbed_official 28:c09a0c9bf425 207 #else
mbed_official 28:c09a0c9bf425 208 /* for other platforms, count on the HAL to handle this case */
mbed_official 28:c09a0c9bf425 209 return false;
mbed_official 28:c09a0c9bf425 210 #endif
samux 1:80ab0d068708 211 }
samux 1:80ab0d068708 212
samux 1:80ab0d068708 213 /* Read from endpoint */
samux 1:80ab0d068708 214 packetSize = EP0getReadResult(buffer);
samux 1:80ab0d068708 215
samux 1:80ab0d068708 216 /* Check if transfer size is valid */
samux 1:80ab0d068708 217 if (packetSize > transfer.remaining)
samux 1:80ab0d068708 218 {
samux 1:80ab0d068708 219 /* Too big */
samux 1:80ab0d068708 220 return false;
samux 1:80ab0d068708 221 }
samux 1:80ab0d068708 222
samux 1:80ab0d068708 223 /* Update transfer */
samux 1:80ab0d068708 224 transfer.ptr += packetSize;
samux 1:80ab0d068708 225 transfer.remaining -= packetSize;
samux 1:80ab0d068708 226
samux 1:80ab0d068708 227 /* Check if transfer has completed */
samux 1:80ab0d068708 228 if (transfer.remaining == 0)
samux 1:80ab0d068708 229 {
samux 1:80ab0d068708 230 /* Transfer completed */
samux 1:80ab0d068708 231 if (transfer.notify)
samux 1:80ab0d068708 232 {
samux 1:80ab0d068708 233 /* Notify class layer. */
samux 1:80ab0d068708 234 USBCallback_requestCompleted(buffer, packetSize);
samux 1:80ab0d068708 235 transfer.notify = false;
samux 1:80ab0d068708 236 }
samux 1:80ab0d068708 237 /* Status stage */
samux 1:80ab0d068708 238 EP0write(NULL, 0);
samux 1:80ab0d068708 239 }
samux 1:80ab0d068708 240 else
samux 1:80ab0d068708 241 {
samux 1:80ab0d068708 242 EP0read();
samux 1:80ab0d068708 243 }
samux 1:80ab0d068708 244
samux 1:80ab0d068708 245 return true;
samux 1:80ab0d068708 246 }
samux 1:80ab0d068708 247
samux 1:80ab0d068708 248 bool USBDevice::controlIn(void)
samux 1:80ab0d068708 249 {
samux 1:80ab0d068708 250 /* Control transfer data IN stage */
samux 1:80ab0d068708 251 uint32_t packetSize;
samux 1:80ab0d068708 252
samux 1:80ab0d068708 253 /* Check if transfer has completed (status stage transactions */
samux 1:80ab0d068708 254 /* also have transfer.remaining == 0) */
samux 1:80ab0d068708 255 if (transfer.remaining == 0)
samux 1:80ab0d068708 256 {
samux 1:80ab0d068708 257 if (transfer.zlp)
samux 1:80ab0d068708 258 {
samux 1:80ab0d068708 259 /* Send zero length packet */
samux 1:80ab0d068708 260 EP0write(NULL, 0);
samux 1:80ab0d068708 261 transfer.zlp = false;
samux 1:80ab0d068708 262 }
samux 1:80ab0d068708 263
samux 1:80ab0d068708 264 /* Transfer completed */
samux 1:80ab0d068708 265 if (transfer.notify)
samux 1:80ab0d068708 266 {
samux 1:80ab0d068708 267 /* Notify class layer. */
samux 1:80ab0d068708 268 USBCallback_requestCompleted(NULL, 0);
samux 1:80ab0d068708 269 transfer.notify = false;
samux 1:80ab0d068708 270 }
samux 1:80ab0d068708 271
samux 1:80ab0d068708 272 EP0read();
samux 8:335f2506f422 273 EP0readStage();
samux 1:80ab0d068708 274
samux 1:80ab0d068708 275 /* Completed */
samux 1:80ab0d068708 276 return true;
samux 1:80ab0d068708 277 }
samux 1:80ab0d068708 278
samux 1:80ab0d068708 279 /* Check we should be transferring data IN */
samux 1:80ab0d068708 280 if (transfer.direction != DEVICE_TO_HOST)
samux 1:80ab0d068708 281 {
samux 1:80ab0d068708 282 return false;
samux 1:80ab0d068708 283 }
samux 1:80ab0d068708 284
samux 1:80ab0d068708 285 packetSize = transfer.remaining;
samux 1:80ab0d068708 286
samux 1:80ab0d068708 287 if (packetSize > MAX_PACKET_SIZE_EP0)
samux 1:80ab0d068708 288 {
samux 1:80ab0d068708 289 packetSize = MAX_PACKET_SIZE_EP0;
samux 1:80ab0d068708 290 }
samux 1:80ab0d068708 291
samux 1:80ab0d068708 292 /* Write to endpoint */
samux 1:80ab0d068708 293 EP0write(transfer.ptr, packetSize);
samux 1:80ab0d068708 294
samux 1:80ab0d068708 295 /* Update transfer */
samux 1:80ab0d068708 296 transfer.ptr += packetSize;
samux 1:80ab0d068708 297 transfer.remaining -= packetSize;
samux 1:80ab0d068708 298
samux 1:80ab0d068708 299 return true;
samux 1:80ab0d068708 300 }
samux 1:80ab0d068708 301
samux 1:80ab0d068708 302 bool USBDevice::requestSetAddress(void)
samux 1:80ab0d068708 303 {
samux 1:80ab0d068708 304 /* Set the device address */
samux 1:80ab0d068708 305 setAddress(transfer.setup.wValue);
samux 1:80ab0d068708 306
samux 1:80ab0d068708 307 if (transfer.setup.wValue == 0)
samux 1:80ab0d068708 308 {
samux 1:80ab0d068708 309 device.state = DEFAULT;
samux 1:80ab0d068708 310 }
samux 1:80ab0d068708 311 else
samux 1:80ab0d068708 312 {
samux 1:80ab0d068708 313 device.state = ADDRESS;
samux 1:80ab0d068708 314 }
samux 1:80ab0d068708 315
samux 1:80ab0d068708 316 return true;
samux 1:80ab0d068708 317 }
samux 1:80ab0d068708 318
samux 1:80ab0d068708 319 bool USBDevice::requestSetConfiguration(void)
samux 1:80ab0d068708 320 {
samux 1:80ab0d068708 321
samux 1:80ab0d068708 322 device.configuration = transfer.setup.wValue;
samux 1:80ab0d068708 323 /* Set the device configuration */
samux 1:80ab0d068708 324 if (device.configuration == 0)
samux 1:80ab0d068708 325 {
samux 1:80ab0d068708 326 /* Not configured */
samux 1:80ab0d068708 327 unconfigureDevice();
samux 1:80ab0d068708 328 device.state = ADDRESS;
samux 1:80ab0d068708 329 }
samux 1:80ab0d068708 330 else
samux 1:80ab0d068708 331 {
samux 1:80ab0d068708 332 if (USBCallback_setConfiguration(device.configuration))
samux 1:80ab0d068708 333 {
samux 1:80ab0d068708 334 /* Valid configuration */
samux 1:80ab0d068708 335 configureDevice();
samux 1:80ab0d068708 336 device.state = CONFIGURED;
samux 1:80ab0d068708 337 }
samux 1:80ab0d068708 338 else
samux 1:80ab0d068708 339 {
samux 1:80ab0d068708 340 return false;
samux 1:80ab0d068708 341 }
samux 1:80ab0d068708 342 }
samux 1:80ab0d068708 343
samux 1:80ab0d068708 344 return true;
samux 1:80ab0d068708 345 }
samux 1:80ab0d068708 346
samux 1:80ab0d068708 347 bool USBDevice::requestGetConfiguration(void)
samux 1:80ab0d068708 348 {
samux 1:80ab0d068708 349 /* Send the device configuration */
samux 1:80ab0d068708 350 transfer.ptr = &device.configuration;
samux 1:80ab0d068708 351 transfer.remaining = sizeof(device.configuration);
samux 1:80ab0d068708 352 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 353 return true;
samux 1:80ab0d068708 354 }
samux 1:80ab0d068708 355
samux 1:80ab0d068708 356 bool USBDevice::requestGetInterface(void)
samux 1:80ab0d068708 357 {
samux 1:80ab0d068708 358 /* Return the selected alternate setting for an interface */
samux 1:80ab0d068708 359
samux 1:80ab0d068708 360 if (device.state != CONFIGURED)
samux 1:80ab0d068708 361 {
samux 1:80ab0d068708 362 return false;
samux 1:80ab0d068708 363 }
samux 1:80ab0d068708 364
samux 1:80ab0d068708 365 /* Send the alternate setting */
samux 1:80ab0d068708 366 transfer.setup.wIndex = currentInterface;
samux 1:80ab0d068708 367 transfer.ptr = &currentAlternate;
samux 1:80ab0d068708 368 transfer.remaining = sizeof(currentAlternate);
samux 1:80ab0d068708 369 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 370 return true;
samux 1:80ab0d068708 371 }
samux 1:80ab0d068708 372
samux 1:80ab0d068708 373 bool USBDevice::requestSetInterface(void)
samux 1:80ab0d068708 374 {
samux 1:80ab0d068708 375 bool success = false;
samux 1:80ab0d068708 376 if(USBCallback_setInterface(transfer.setup.wIndex, transfer.setup.wValue))
samux 1:80ab0d068708 377 {
samux 1:80ab0d068708 378 success = true;
samux 1:80ab0d068708 379 currentInterface = transfer.setup.wIndex;
mbed_official 25:7c72828865f3 380 currentAlternate = transfer.setup.wValue;
samux 1:80ab0d068708 381 }
samux 1:80ab0d068708 382 return success;
samux 1:80ab0d068708 383 }
samux 1:80ab0d068708 384
samux 1:80ab0d068708 385 bool USBDevice::requestSetFeature()
samux 1:80ab0d068708 386 {
samux 1:80ab0d068708 387 bool success = false;
samux 1:80ab0d068708 388
samux 1:80ab0d068708 389 if (device.state != CONFIGURED)
samux 1:80ab0d068708 390 {
samux 1:80ab0d068708 391 /* Endpoint or interface must be zero */
samux 1:80ab0d068708 392 if (transfer.setup.wIndex != 0)
samux 1:80ab0d068708 393 {
samux 1:80ab0d068708 394 return false;
samux 1:80ab0d068708 395 }
samux 1:80ab0d068708 396 }
samux 1:80ab0d068708 397
samux 1:80ab0d068708 398 switch (transfer.setup.bmRequestType.Recipient)
samux 1:80ab0d068708 399 {
samux 1:80ab0d068708 400 case DEVICE_RECIPIENT:
samux 1:80ab0d068708 401 /* TODO: Remote wakeup feature not supported */
samux 1:80ab0d068708 402 break;
samux 1:80ab0d068708 403 case ENDPOINT_RECIPIENT:
samux 1:80ab0d068708 404 if (transfer.setup.wValue == ENDPOINT_HALT)
samux 1:80ab0d068708 405 {
samux 1:80ab0d068708 406 /* TODO: We should check that the endpoint number is valid */
samux 1:80ab0d068708 407 stallEndpoint(
samux 1:80ab0d068708 408 WINDEX_TO_PHYSICAL(transfer.setup.wIndex));
samux 1:80ab0d068708 409 success = true;
samux 1:80ab0d068708 410 }
samux 1:80ab0d068708 411 break;
samux 1:80ab0d068708 412 default:
samux 1:80ab0d068708 413 break;
samux 1:80ab0d068708 414 }
samux 1:80ab0d068708 415
samux 1:80ab0d068708 416 return success;
samux 1:80ab0d068708 417 }
samux 1:80ab0d068708 418
samux 1:80ab0d068708 419 bool USBDevice::requestClearFeature()
samux 1:80ab0d068708 420 {
samux 1:80ab0d068708 421 bool success = false;
samux 1:80ab0d068708 422
samux 1:80ab0d068708 423 if (device.state != CONFIGURED)
samux 1:80ab0d068708 424 {
samux 1:80ab0d068708 425 /* Endpoint or interface must be zero */
samux 1:80ab0d068708 426 if (transfer.setup.wIndex != 0)
samux 1:80ab0d068708 427 {
samux 1:80ab0d068708 428 return false;
samux 1:80ab0d068708 429 }
samux 1:80ab0d068708 430 }
samux 1:80ab0d068708 431
samux 1:80ab0d068708 432 switch (transfer.setup.bmRequestType.Recipient)
samux 1:80ab0d068708 433 {
samux 1:80ab0d068708 434 case DEVICE_RECIPIENT:
samux 1:80ab0d068708 435 /* TODO: Remote wakeup feature not supported */
samux 1:80ab0d068708 436 break;
samux 1:80ab0d068708 437 case ENDPOINT_RECIPIENT:
samux 1:80ab0d068708 438 /* TODO: We should check that the endpoint number is valid */
samux 1:80ab0d068708 439 if (transfer.setup.wValue == ENDPOINT_HALT)
samux 1:80ab0d068708 440 {
samux 1:80ab0d068708 441 unstallEndpoint( WINDEX_TO_PHYSICAL(transfer.setup.wIndex));
samux 1:80ab0d068708 442 success = true;
samux 1:80ab0d068708 443 }
samux 1:80ab0d068708 444 break;
samux 1:80ab0d068708 445 default:
samux 1:80ab0d068708 446 break;
samux 1:80ab0d068708 447 }
samux 1:80ab0d068708 448
samux 1:80ab0d068708 449 return success;
samux 1:80ab0d068708 450 }
samux 1:80ab0d068708 451
samux 1:80ab0d068708 452 bool USBDevice::requestGetStatus(void)
samux 1:80ab0d068708 453 {
samux 1:80ab0d068708 454 static uint16_t status;
samux 1:80ab0d068708 455 bool success = false;
samux 1:80ab0d068708 456
samux 1:80ab0d068708 457 if (device.state != CONFIGURED)
samux 1:80ab0d068708 458 {
samux 1:80ab0d068708 459 /* Endpoint or interface must be zero */
samux 1:80ab0d068708 460 if (transfer.setup.wIndex != 0)
samux 1:80ab0d068708 461 {
samux 1:80ab0d068708 462 return false;
samux 1:80ab0d068708 463 }
samux 1:80ab0d068708 464 }
samux 1:80ab0d068708 465
samux 1:80ab0d068708 466 switch (transfer.setup.bmRequestType.Recipient)
samux 1:80ab0d068708 467 {
samux 1:80ab0d068708 468 case DEVICE_RECIPIENT:
samux 1:80ab0d068708 469 /* TODO: Currently only supports self powered devices */
samux 1:80ab0d068708 470 status = DEVICE_STATUS_SELF_POWERED;
samux 1:80ab0d068708 471 success = true;
samux 1:80ab0d068708 472 break;
samux 1:80ab0d068708 473 case INTERFACE_RECIPIENT:
samux 1:80ab0d068708 474 status = 0;
samux 1:80ab0d068708 475 success = true;
samux 1:80ab0d068708 476 break;
samux 1:80ab0d068708 477 case ENDPOINT_RECIPIENT:
samux 1:80ab0d068708 478 /* TODO: We should check that the endpoint number is valid */
samux 1:80ab0d068708 479 if (getEndpointStallState(
samux 1:80ab0d068708 480 WINDEX_TO_PHYSICAL(transfer.setup.wIndex)))
samux 1:80ab0d068708 481 {
samux 1:80ab0d068708 482 status = ENDPOINT_STATUS_HALT;
samux 1:80ab0d068708 483 }
samux 1:80ab0d068708 484 else
samux 1:80ab0d068708 485 {
samux 1:80ab0d068708 486 status = 0;
samux 1:80ab0d068708 487 }
samux 1:80ab0d068708 488 success = true;
samux 1:80ab0d068708 489 break;
samux 1:80ab0d068708 490 default:
samux 1:80ab0d068708 491 break;
samux 1:80ab0d068708 492 }
samux 1:80ab0d068708 493
samux 1:80ab0d068708 494 if (success)
samux 1:80ab0d068708 495 {
mbed_official 25:7c72828865f3 496 /* Send the status */
samux 1:80ab0d068708 497 transfer.ptr = (uint8_t *)&status; /* Assumes little endian */
samux 1:80ab0d068708 498 transfer.remaining = sizeof(status);
samux 1:80ab0d068708 499 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 500 }
mbed_official 25:7c72828865f3 501
samux 1:80ab0d068708 502 return success;
samux 1:80ab0d068708 503 }
samux 1:80ab0d068708 504
samux 1:80ab0d068708 505 bool USBDevice::requestSetup(void)
samux 1:80ab0d068708 506 {
samux 1:80ab0d068708 507 bool success = false;
samux 1:80ab0d068708 508
samux 1:80ab0d068708 509 /* Process standard requests */
samux 1:80ab0d068708 510 if ((transfer.setup.bmRequestType.Type == STANDARD_TYPE))
samux 1:80ab0d068708 511 {
samux 1:80ab0d068708 512 switch (transfer.setup.bRequest)
samux 1:80ab0d068708 513 {
samux 1:80ab0d068708 514 case GET_STATUS:
samux 1:80ab0d068708 515 success = requestGetStatus();
samux 1:80ab0d068708 516 break;
samux 1:80ab0d068708 517 case CLEAR_FEATURE:
samux 1:80ab0d068708 518 success = requestClearFeature();
samux 1:80ab0d068708 519 break;
samux 1:80ab0d068708 520 case SET_FEATURE:
samux 1:80ab0d068708 521 success = requestSetFeature();
samux 1:80ab0d068708 522 break;
samux 1:80ab0d068708 523 case SET_ADDRESS:
samux 1:80ab0d068708 524 success = requestSetAddress();
samux 1:80ab0d068708 525 break;
samux 1:80ab0d068708 526 case GET_DESCRIPTOR:
samux 1:80ab0d068708 527 success = requestGetDescriptor();
samux 1:80ab0d068708 528 break;
samux 1:80ab0d068708 529 case SET_DESCRIPTOR:
samux 1:80ab0d068708 530 /* TODO: Support is optional, not implemented here */
samux 1:80ab0d068708 531 success = false;
samux 1:80ab0d068708 532 break;
samux 1:80ab0d068708 533 case GET_CONFIGURATION:
samux 1:80ab0d068708 534 success = requestGetConfiguration();
samux 1:80ab0d068708 535 break;
samux 1:80ab0d068708 536 case SET_CONFIGURATION:
samux 1:80ab0d068708 537 success = requestSetConfiguration();
samux 1:80ab0d068708 538 break;
samux 1:80ab0d068708 539 case GET_INTERFACE:
samux 1:80ab0d068708 540 success = requestGetInterface();
samux 1:80ab0d068708 541 break;
samux 1:80ab0d068708 542 case SET_INTERFACE:
samux 1:80ab0d068708 543 success = requestSetInterface();
samux 1:80ab0d068708 544 break;
samux 1:80ab0d068708 545 default:
samux 1:80ab0d068708 546 break;
samux 1:80ab0d068708 547 }
samux 1:80ab0d068708 548 }
samux 1:80ab0d068708 549
samux 1:80ab0d068708 550 return success;
samux 1:80ab0d068708 551 }
samux 1:80ab0d068708 552
samux 1:80ab0d068708 553 bool USBDevice::controlSetup(void)
samux 1:80ab0d068708 554 {
samux 1:80ab0d068708 555 bool success = false;
samux 1:80ab0d068708 556
samux 1:80ab0d068708 557 /* Control transfer setup stage */
samux 1:80ab0d068708 558 uint8_t buffer[MAX_PACKET_SIZE_EP0];
samux 1:80ab0d068708 559
samux 1:80ab0d068708 560 EP0setup(buffer);
samux 1:80ab0d068708 561
samux 1:80ab0d068708 562 /* Initialise control transfer state */
samux 1:80ab0d068708 563 decodeSetupPacket(buffer, &transfer.setup);
samux 1:80ab0d068708 564 transfer.ptr = NULL;
samux 1:80ab0d068708 565 transfer.remaining = 0;
samux 1:80ab0d068708 566 transfer.direction = 0;
samux 1:80ab0d068708 567 transfer.zlp = false;
samux 1:80ab0d068708 568 transfer.notify = false;
mbed_official 25:7c72828865f3 569
samux 1:80ab0d068708 570 #ifdef DEBUG
samux 1:80ab0d068708 571 printf("dataTransferDirection: %d\r\nType: %d\r\nRecipient: %d\r\nbRequest: %d\r\nwValue: %d\r\nwIndex: %d\r\nwLength: %d\r\n",transfer.setup.bmRequestType.dataTransferDirection,
samux 1:80ab0d068708 572 transfer.setup.bmRequestType.Type,
samux 1:80ab0d068708 573 transfer.setup.bmRequestType.Recipient,
samux 1:80ab0d068708 574 transfer.setup.bRequest,
samux 1:80ab0d068708 575 transfer.setup.wValue,
samux 1:80ab0d068708 576 transfer.setup.wIndex,
samux 1:80ab0d068708 577 transfer.setup.wLength);
samux 1:80ab0d068708 578 #endif
samux 1:80ab0d068708 579
samux 1:80ab0d068708 580 /* Class / vendor specific */
samux 1:80ab0d068708 581 success = USBCallback_request();
samux 1:80ab0d068708 582
samux 1:80ab0d068708 583 if (!success)
samux 1:80ab0d068708 584 {
samux 1:80ab0d068708 585 /* Standard requests */
samux 1:80ab0d068708 586 if (!requestSetup())
samux 1:80ab0d068708 587 {
samux 1:80ab0d068708 588 #ifdef DEBUG
samux 1:80ab0d068708 589 printf("fail!!!!\r\n");
samux 1:80ab0d068708 590 #endif
samux 1:80ab0d068708 591 return false;
samux 1:80ab0d068708 592 }
samux 1:80ab0d068708 593 }
samux 1:80ab0d068708 594
samux 1:80ab0d068708 595 /* Check transfer size and direction */
samux 1:80ab0d068708 596 if (transfer.setup.wLength>0)
samux 1:80ab0d068708 597 {
samux 1:80ab0d068708 598 if (transfer.setup.bmRequestType.dataTransferDirection \
samux 1:80ab0d068708 599 == DEVICE_TO_HOST)
samux 1:80ab0d068708 600 {
samux 1:80ab0d068708 601 /* IN data stage is required */
samux 1:80ab0d068708 602 if (transfer.direction != DEVICE_TO_HOST)
samux 1:80ab0d068708 603 {
samux 1:80ab0d068708 604 return false;
samux 1:80ab0d068708 605 }
samux 1:80ab0d068708 606
samux 1:80ab0d068708 607 /* Transfer must be less than or equal to the size */
samux 1:80ab0d068708 608 /* requested by the host */
samux 1:80ab0d068708 609 if (transfer.remaining > transfer.setup.wLength)
samux 1:80ab0d068708 610 {
samux 1:80ab0d068708 611 transfer.remaining = transfer.setup.wLength;
samux 1:80ab0d068708 612 }
samux 1:80ab0d068708 613 }
samux 1:80ab0d068708 614 else
samux 1:80ab0d068708 615 {
mbed_official 25:7c72828865f3 616
samux 1:80ab0d068708 617 /* OUT data stage is required */
samux 1:80ab0d068708 618 if (transfer.direction != HOST_TO_DEVICE)
samux 1:80ab0d068708 619 {
samux 1:80ab0d068708 620 return false;
samux 1:80ab0d068708 621 }
samux 1:80ab0d068708 622
samux 1:80ab0d068708 623 /* Transfer must be equal to the size requested by the host */
samux 1:80ab0d068708 624 if (transfer.remaining != transfer.setup.wLength)
samux 1:80ab0d068708 625 {
samux 1:80ab0d068708 626 return false;
samux 1:80ab0d068708 627 }
samux 1:80ab0d068708 628 }
samux 1:80ab0d068708 629 }
samux 1:80ab0d068708 630 else
samux 1:80ab0d068708 631 {
samux 1:80ab0d068708 632 /* No data stage; transfer size must be zero */
samux 1:80ab0d068708 633 if (transfer.remaining != 0)
samux 1:80ab0d068708 634 {
samux 1:80ab0d068708 635 return false;
samux 1:80ab0d068708 636 }
samux 1:80ab0d068708 637 }
samux 1:80ab0d068708 638
samux 1:80ab0d068708 639 /* Data or status stage if applicable */
samux 1:80ab0d068708 640 if (transfer.setup.wLength>0)
samux 1:80ab0d068708 641 {
samux 1:80ab0d068708 642 if (transfer.setup.bmRequestType.dataTransferDirection \
samux 1:80ab0d068708 643 == DEVICE_TO_HOST)
samux 1:80ab0d068708 644 {
samux 1:80ab0d068708 645 /* Check if we'll need to send a zero length packet at */
samux 1:80ab0d068708 646 /* the end of this transfer */
samux 1:80ab0d068708 647 if (transfer.setup.wLength > transfer.remaining)
samux 1:80ab0d068708 648 {
samux 1:80ab0d068708 649 /* Device wishes to transfer less than host requested */
samux 1:80ab0d068708 650 if ((transfer.remaining % MAX_PACKET_SIZE_EP0) == 0)
samux 1:80ab0d068708 651 {
samux 1:80ab0d068708 652 /* Transfer is a multiple of EP0 max packet size */
samux 1:80ab0d068708 653 transfer.zlp = true;
samux 1:80ab0d068708 654 }
samux 1:80ab0d068708 655 }
samux 1:80ab0d068708 656
samux 1:80ab0d068708 657 /* IN stage */
samux 1:80ab0d068708 658 controlIn();
samux 1:80ab0d068708 659 }
samux 1:80ab0d068708 660 else
samux 1:80ab0d068708 661 {
samux 1:80ab0d068708 662 /* OUT stage */
samux 1:80ab0d068708 663 EP0read();
samux 1:80ab0d068708 664 }
samux 1:80ab0d068708 665 }
samux 1:80ab0d068708 666 else
samux 1:80ab0d068708 667 {
samux 1:80ab0d068708 668 /* Status stage */
samux 1:80ab0d068708 669 EP0write(NULL, 0);
samux 1:80ab0d068708 670 }
samux 1:80ab0d068708 671
samux 1:80ab0d068708 672 return true;
samux 1:80ab0d068708 673 }
samux 1:80ab0d068708 674
samux 1:80ab0d068708 675 void USBDevice::busReset(void)
samux 1:80ab0d068708 676 {
samux 1:80ab0d068708 677 device.state = DEFAULT;
samux 1:80ab0d068708 678 device.configuration = 0;
samux 1:80ab0d068708 679 device.suspended = false;
samux 1:80ab0d068708 680
samux 1:80ab0d068708 681 /* Call class / vendor specific busReset function */
samux 1:80ab0d068708 682 USBCallback_busReset();
samux 1:80ab0d068708 683 }
samux 1:80ab0d068708 684
samux 1:80ab0d068708 685 void USBDevice::EP0setupCallback(void)
samux 1:80ab0d068708 686 {
samux 1:80ab0d068708 687 /* Endpoint 0 setup event */
samux 1:80ab0d068708 688 if (!controlSetup())
samux 1:80ab0d068708 689 {
samux 1:80ab0d068708 690 /* Protocol stall */
samux 1:80ab0d068708 691 EP0stall();
samux 1:80ab0d068708 692 }
samux 1:80ab0d068708 693
samux 1:80ab0d068708 694 /* Return true if an OUT data stage is expected */
samux 1:80ab0d068708 695 }
samux 1:80ab0d068708 696
samux 1:80ab0d068708 697 void USBDevice::EP0out(void)
samux 1:80ab0d068708 698 {
samux 1:80ab0d068708 699 /* Endpoint 0 OUT data event */
samux 1:80ab0d068708 700 if (!controlOut())
samux 1:80ab0d068708 701 {
samux 1:80ab0d068708 702 /* Protocol stall; this will stall both endpoints */
samux 1:80ab0d068708 703 EP0stall();
samux 1:80ab0d068708 704 }
samux 1:80ab0d068708 705 }
samux 1:80ab0d068708 706
samux 1:80ab0d068708 707 void USBDevice::EP0in(void)
samux 1:80ab0d068708 708 {
samux 1:80ab0d068708 709 #ifdef DEBUG
samux 1:80ab0d068708 710 printf("EP0IN\r\n");
samux 1:80ab0d068708 711 #endif
samux 1:80ab0d068708 712 /* Endpoint 0 IN data event */
samux 1:80ab0d068708 713 if (!controlIn())
samux 1:80ab0d068708 714 {
samux 1:80ab0d068708 715 /* Protocol stall; this will stall both endpoints */
samux 1:80ab0d068708 716 EP0stall();
samux 1:80ab0d068708 717 }
samux 1:80ab0d068708 718 }
samux 1:80ab0d068708 719
samux 1:80ab0d068708 720 bool USBDevice::configured(void)
samux 1:80ab0d068708 721 {
samux 1:80ab0d068708 722 /* Returns true if device is in the CONFIGURED state */
samux 1:80ab0d068708 723 return (device.state == CONFIGURED);
samux 1:80ab0d068708 724 }
samux 1:80ab0d068708 725
mbed_official 18:78bdbce94509 726 void USBDevice::connect(bool blocking)
samux 1:80ab0d068708 727 {
samux 1:80ab0d068708 728 /* Connect device */
samux 1:80ab0d068708 729 USBHAL::connect();
mbed_official 25:7c72828865f3 730
mbed_official 18:78bdbce94509 731 if (blocking) {
mbed_official 18:78bdbce94509 732 /* Block if not configured */
mbed_official 18:78bdbce94509 733 while (!configured());
mbed_official 18:78bdbce94509 734 }
samux 1:80ab0d068708 735 }
samux 1:80ab0d068708 736
samux 1:80ab0d068708 737 void USBDevice::disconnect(void)
samux 1:80ab0d068708 738 {
samux 1:80ab0d068708 739 /* Disconnect device */
samux 1:80ab0d068708 740 USBHAL::disconnect();
Geir Inge Tellnes 73:fa395f2d24ba 741
mbed_official 26:8ef73dd868a0 742 /* Set initial device state */
mbed_official 26:8ef73dd868a0 743 device.state = POWERED;
mbed_official 26:8ef73dd868a0 744 device.configuration = 0;
mbed_official 26:8ef73dd868a0 745 device.suspended = false;
samux 1:80ab0d068708 746 }
samux 1:80ab0d068708 747
samux 1:80ab0d068708 748 CONTROL_TRANSFER * USBDevice::getTransferPtr(void)
samux 1:80ab0d068708 749 {
samux 1:80ab0d068708 750 return &transfer;
samux 1:80ab0d068708 751 }
samux 1:80ab0d068708 752
samux 1:80ab0d068708 753 bool USBDevice::addEndpoint(uint8_t endpoint, uint32_t maxPacket)
samux 1:80ab0d068708 754 {
samux 1:80ab0d068708 755 return realiseEndpoint(endpoint, maxPacket, 0);
samux 1:80ab0d068708 756 }
samux 1:80ab0d068708 757
samux 1:80ab0d068708 758 bool USBDevice::addRateFeedbackEndpoint(uint8_t endpoint, uint32_t maxPacket)
samux 1:80ab0d068708 759 {
samux 1:80ab0d068708 760 /* For interrupt endpoints only */
samux 1:80ab0d068708 761 return realiseEndpoint(endpoint, maxPacket, RATE_FEEDBACK_MODE);
samux 1:80ab0d068708 762 }
samux 1:80ab0d068708 763
samux 1:80ab0d068708 764 uint8_t * USBDevice::findDescriptor(uint8_t descriptorType)
samux 1:80ab0d068708 765 {
samux 1:80ab0d068708 766 /* Find a descriptor within the list of descriptors */
samux 1:80ab0d068708 767 /* following a configuration descriptor. */
samux 1:80ab0d068708 768 uint16_t wTotalLength;
samux 1:80ab0d068708 769 uint8_t *ptr;
samux 1:80ab0d068708 770
samux 1:80ab0d068708 771 if (configurationDesc() == NULL)
samux 1:80ab0d068708 772 {
samux 1:80ab0d068708 773 return NULL;
samux 1:80ab0d068708 774 }
samux 1:80ab0d068708 775
samux 1:80ab0d068708 776 /* Check this is a configuration descriptor */
samux 1:80ab0d068708 777 if ((configurationDesc()[0] != CONFIGURATION_DESCRIPTOR_LENGTH) \
samux 1:80ab0d068708 778 || (configurationDesc()[1] != CONFIGURATION_DESCRIPTOR))
samux 1:80ab0d068708 779 {
samux 1:80ab0d068708 780 return NULL;
samux 1:80ab0d068708 781 }
samux 1:80ab0d068708 782
samux 1:80ab0d068708 783 wTotalLength = configurationDesc()[2] | (configurationDesc()[3] << 8);
samux 1:80ab0d068708 784
samux 1:80ab0d068708 785 /* Check there are some more descriptors to follow */
samux 1:80ab0d068708 786 if (wTotalLength <= (CONFIGURATION_DESCRIPTOR_LENGTH+2))
samux 1:80ab0d068708 787 /* +2 is for bLength and bDescriptorType of next descriptor */
samux 1:80ab0d068708 788 {
bogdanm 11:eeb3cbbaa996 789 return NULL;
samux 1:80ab0d068708 790 }
samux 1:80ab0d068708 791
samux 1:80ab0d068708 792 /* Start at first descriptor after the configuration descriptor */
samux 1:80ab0d068708 793 ptr = &(configurationDesc()[CONFIGURATION_DESCRIPTOR_LENGTH]);
samux 1:80ab0d068708 794
samux 1:80ab0d068708 795 do {
samux 1:80ab0d068708 796 if (ptr[1] /* bDescriptorType */ == descriptorType)
samux 1:80ab0d068708 797 {
samux 1:80ab0d068708 798 /* Found */
samux 1:80ab0d068708 799 return ptr;
samux 1:80ab0d068708 800 }
samux 1:80ab0d068708 801
samux 1:80ab0d068708 802 /* Skip to next descriptor */
samux 1:80ab0d068708 803 ptr += ptr[0]; /* bLength */
samux 1:80ab0d068708 804 } while (ptr < (configurationDesc() + wTotalLength));
samux 1:80ab0d068708 805
samux 1:80ab0d068708 806 /* Reached end of the descriptors - not found */
samux 1:80ab0d068708 807 return NULL;
samux 1:80ab0d068708 808 }
samux 1:80ab0d068708 809
samux 1:80ab0d068708 810
samux 1:80ab0d068708 811 void USBDevice::connectStateChanged(unsigned int connected)
samux 1:80ab0d068708 812 {
samux 1:80ab0d068708 813 }
samux 1:80ab0d068708 814
samux 1:80ab0d068708 815 void USBDevice::suspendStateChanged(unsigned int suspended)
samux 1:80ab0d068708 816 {
samux 1:80ab0d068708 817 }
samux 1:80ab0d068708 818
samux 1:80ab0d068708 819
samux 1:80ab0d068708 820 USBDevice::USBDevice(uint16_t vendor_id, uint16_t product_id, uint16_t product_release){
mbed_official 25:7c72828865f3 821 VENDOR_ID = vendor_id;
mbed_official 25:7c72828865f3 822 PRODUCT_ID = product_id;
samux 1:80ab0d068708 823 PRODUCT_RELEASE = product_release;
samux 1:80ab0d068708 824
samux 1:80ab0d068708 825 /* Set initial device state */
samux 1:80ab0d068708 826 device.state = POWERED;
samux 1:80ab0d068708 827 device.configuration = 0;
samux 1:80ab0d068708 828 device.suspended = false;
samux 1:80ab0d068708 829 };
samux 1:80ab0d068708 830
samux 1:80ab0d068708 831
samux 1:80ab0d068708 832 bool USBDevice::readStart(uint8_t endpoint, uint32_t maxSize)
samux 1:80ab0d068708 833 {
samux 1:80ab0d068708 834 return endpointRead(endpoint, maxSize) == EP_PENDING;
samux 1:80ab0d068708 835 }
samux 1:80ab0d068708 836
samux 1:80ab0d068708 837
samux 1:80ab0d068708 838 bool USBDevice::write(uint8_t endpoint, uint8_t * buffer, uint32_t size, uint32_t maxSize)
samux 1:80ab0d068708 839 {
samux 1:80ab0d068708 840 EP_STATUS result;
samux 1:80ab0d068708 841
samux 1:80ab0d068708 842 if (size > maxSize)
samux 1:80ab0d068708 843 {
samux 1:80ab0d068708 844 return false;
samux 1:80ab0d068708 845 }
mbed_official 25:7c72828865f3 846
mbed_official 25:7c72828865f3 847
samux 1:80ab0d068708 848 if(!configured()) {
samux 1:80ab0d068708 849 return false;
samux 1:80ab0d068708 850 }
mbed_official 25:7c72828865f3 851
samux 1:80ab0d068708 852 /* Send report */
samux 1:80ab0d068708 853 result = endpointWrite(endpoint, buffer, size);
samux 1:80ab0d068708 854
samux 1:80ab0d068708 855 if (result != EP_PENDING)
samux 1:80ab0d068708 856 {
samux 1:80ab0d068708 857 return false;
samux 1:80ab0d068708 858 }
samux 1:80ab0d068708 859
Geir Inge Tellnes 73:fa395f2d24ba 860 #if (USB_DEVICE_WRITE_BLOCKING_TIMEOUT_MS != 0)
Geir Inge Tellnes 73:fa395f2d24ba 861 uint32_t tstart = osKernelGetTickCount();
Geir Inge Tellnes 73:fa395f2d24ba 862 #endif
samux 1:80ab0d068708 863 /* Wait for completion */
samux 1:80ab0d068708 864 do {
samux 1:80ab0d068708 865 result = endpointWriteResult(endpoint);
Geir Inge Tellnes 73:fa395f2d24ba 866
Geir Inge Tellnes 73:fa395f2d24ba 867 #if (USB_DEVICE_WRITE_BLOCKING_TIMEOUT_MS != 0)
Geir Inge Tellnes 73:fa395f2d24ba 868 /* Escape blocking write if blocking write timeout is configured */
Geir Inge Tellnes 73:fa395f2d24ba 869 if ((osKernelGetTickCount()-tstart) > (USB_DEVICE_WRITE_BLOCKING_TIMEOUT_MS)) {
Geir Inge Tellnes 73:fa395f2d24ba 870 break;
Geir Inge Tellnes 73:fa395f2d24ba 871 }
Geir Inge Tellnes 73:fa395f2d24ba 872 #endif
samux 1:80ab0d068708 873 } while ((result == EP_PENDING) && configured());
samux 1:80ab0d068708 874
samux 1:80ab0d068708 875 return (result == EP_COMPLETED);
samux 1:80ab0d068708 876 }
samux 1:80ab0d068708 877
samux 1:80ab0d068708 878
samux 1:80ab0d068708 879 bool USBDevice::writeNB(uint8_t endpoint, uint8_t * buffer, uint32_t size, uint32_t maxSize)
samux 1:80ab0d068708 880 {
samux 1:80ab0d068708 881 EP_STATUS result;
samux 1:80ab0d068708 882
samux 1:80ab0d068708 883 if (size > maxSize)
samux 1:80ab0d068708 884 {
samux 1:80ab0d068708 885 return false;
samux 1:80ab0d068708 886 }
mbed_official 25:7c72828865f3 887
samux 1:80ab0d068708 888 if(!configured()) {
samux 1:80ab0d068708 889 return false;
samux 1:80ab0d068708 890 }
samux 1:80ab0d068708 891
samux 1:80ab0d068708 892 /* Send report */
samux 1:80ab0d068708 893 result = endpointWrite(endpoint, buffer, size);
samux 1:80ab0d068708 894
samux 1:80ab0d068708 895 if (result != EP_PENDING)
samux 1:80ab0d068708 896 {
samux 1:80ab0d068708 897 return false;
samux 1:80ab0d068708 898 }
samux 1:80ab0d068708 899
samux 1:80ab0d068708 900 result = endpointWriteResult(endpoint);
samux 1:80ab0d068708 901
samux 1:80ab0d068708 902 return (result == EP_COMPLETED);
samux 1:80ab0d068708 903 }
samux 1:80ab0d068708 904
samux 1:80ab0d068708 905
samux 1:80ab0d068708 906
samux 1:80ab0d068708 907 bool USBDevice::readEP(uint8_t endpoint, uint8_t * buffer, uint32_t * size, uint32_t maxSize)
samux 1:80ab0d068708 908 {
samux 1:80ab0d068708 909 EP_STATUS result;
mbed_official 25:7c72828865f3 910
samux 1:80ab0d068708 911 if(!configured()) {
samux 1:80ab0d068708 912 return false;
samux 1:80ab0d068708 913 }
samux 1:80ab0d068708 914
samux 1:80ab0d068708 915 /* Wait for completion */
samux 1:80ab0d068708 916 do {
samux 1:80ab0d068708 917 result = endpointReadResult(endpoint, buffer, size);
samux 1:80ab0d068708 918 } while ((result == EP_PENDING) && configured());
samux 1:80ab0d068708 919
samux 1:80ab0d068708 920 return (result == EP_COMPLETED);
samux 1:80ab0d068708 921 }
samux 1:80ab0d068708 922
samux 1:80ab0d068708 923
samux 1:80ab0d068708 924 bool USBDevice::readEP_NB(uint8_t endpoint, uint8_t * buffer, uint32_t * size, uint32_t maxSize)
samux 1:80ab0d068708 925 {
samux 1:80ab0d068708 926 EP_STATUS result;
mbed_official 25:7c72828865f3 927
samux 1:80ab0d068708 928 if(!configured()) {
samux 1:80ab0d068708 929 return false;
samux 1:80ab0d068708 930 }
samux 1:80ab0d068708 931
samux 1:80ab0d068708 932 result = endpointReadResult(endpoint, buffer, size);
mbed_official 25:7c72828865f3 933
samux 1:80ab0d068708 934 return (result == EP_COMPLETED);
samux 1:80ab0d068708 935 }
samux 1:80ab0d068708 936
samux 1:80ab0d068708 937
samux 1:80ab0d068708 938
samux 1:80ab0d068708 939 uint8_t * USBDevice::deviceDesc() {
samux 1:80ab0d068708 940 static uint8_t deviceDescriptor[] = {
samux 1:80ab0d068708 941 DEVICE_DESCRIPTOR_LENGTH, /* bLength */
samux 1:80ab0d068708 942 DEVICE_DESCRIPTOR, /* bDescriptorType */
samux 1:80ab0d068708 943 LSB(USB_VERSION_2_0), /* bcdUSB (LSB) */
samux 1:80ab0d068708 944 MSB(USB_VERSION_2_0), /* bcdUSB (MSB) */
samux 1:80ab0d068708 945 0x00, /* bDeviceClass */
samux 1:80ab0d068708 946 0x00, /* bDeviceSubClass */
samux 1:80ab0d068708 947 0x00, /* bDeviceprotocol */
samux 1:80ab0d068708 948 MAX_PACKET_SIZE_EP0, /* bMaxPacketSize0 */
bogdanm 11:eeb3cbbaa996 949 (uint8_t)(LSB(VENDOR_ID)), /* idVendor (LSB) */
bogdanm 11:eeb3cbbaa996 950 (uint8_t)(MSB(VENDOR_ID)), /* idVendor (MSB) */
bogdanm 11:eeb3cbbaa996 951 (uint8_t)(LSB(PRODUCT_ID)), /* idProduct (LSB) */
bogdanm 11:eeb3cbbaa996 952 (uint8_t)(MSB(PRODUCT_ID)), /* idProduct (MSB) */
bogdanm 11:eeb3cbbaa996 953 (uint8_t)(LSB(PRODUCT_RELEASE)), /* bcdDevice (LSB) */
bogdanm 11:eeb3cbbaa996 954 (uint8_t)(MSB(PRODUCT_RELEASE)), /* bcdDevice (MSB) */
samux 1:80ab0d068708 955 STRING_OFFSET_IMANUFACTURER, /* iManufacturer */
samux 1:80ab0d068708 956 STRING_OFFSET_IPRODUCT, /* iProduct */
samux 1:80ab0d068708 957 STRING_OFFSET_ISERIAL, /* iSerialNumber */
samux 1:80ab0d068708 958 0x01 /* bNumConfigurations */
samux 1:80ab0d068708 959 };
samux 1:80ab0d068708 960 return deviceDescriptor;
samux 1:80ab0d068708 961 }
samux 1:80ab0d068708 962
samux 1:80ab0d068708 963 uint8_t * USBDevice::stringLangidDesc() {
samux 1:80ab0d068708 964 static uint8_t stringLangidDescriptor[] = {
samux 1:80ab0d068708 965 0x04, /*bLength*/
samux 1:80ab0d068708 966 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
mbed_official 17:bbd6dac92961 967 0x09,0x04, /*bString Lang ID - 0x0409 - English*/
samux 1:80ab0d068708 968 };
samux 1:80ab0d068708 969 return stringLangidDescriptor;
samux 1:80ab0d068708 970 }
samux 1:80ab0d068708 971
samux 1:80ab0d068708 972 uint8_t * USBDevice::stringImanufacturerDesc() {
samux 1:80ab0d068708 973 static uint8_t stringImanufacturerDescriptor[] = {
samux 1:80ab0d068708 974 0x12, /*bLength*/
samux 1:80ab0d068708 975 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 976 'm',0,'b',0,'e',0,'d',0,'.',0,'o',0,'r',0,'g',0, /*bString iManufacturer - mbed.org*/
samux 1:80ab0d068708 977 };
samux 1:80ab0d068708 978 return stringImanufacturerDescriptor;
samux 1:80ab0d068708 979 }
samux 1:80ab0d068708 980
samux 1:80ab0d068708 981 uint8_t * USBDevice::stringIserialDesc() {
samux 1:80ab0d068708 982 static uint8_t stringIserialDescriptor[] = {
samux 1:80ab0d068708 983 0x16, /*bLength*/
samux 1:80ab0d068708 984 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 985 '0',0,'1',0,'2',0,'3',0,'4',0,'5',0,'6',0,'7',0,'8',0,'9',0, /*bString iSerial - 0123456789*/
samux 1:80ab0d068708 986 };
samux 1:80ab0d068708 987 return stringIserialDescriptor;
samux 1:80ab0d068708 988 }
samux 1:80ab0d068708 989
samux 1:80ab0d068708 990 uint8_t * USBDevice::stringIConfigurationDesc() {
samux 1:80ab0d068708 991 static uint8_t stringIconfigurationDescriptor[] = {
samux 1:80ab0d068708 992 0x06, /*bLength*/
samux 1:80ab0d068708 993 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 994 '0',0,'1',0, /*bString iConfiguration - 01*/
samux 1:80ab0d068708 995 };
samux 1:80ab0d068708 996 return stringIconfigurationDescriptor;
samux 1:80ab0d068708 997 }
samux 1:80ab0d068708 998
samux 1:80ab0d068708 999 uint8_t * USBDevice::stringIinterfaceDesc() {
samux 1:80ab0d068708 1000 static uint8_t stringIinterfaceDescriptor[] = {
samux 1:80ab0d068708 1001 0x08, /*bLength*/
samux 1:80ab0d068708 1002 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1003 'U',0,'S',0,'B',0, /*bString iInterface - USB*/
samux 1:80ab0d068708 1004 };
samux 1:80ab0d068708 1005 return stringIinterfaceDescriptor;
samux 1:80ab0d068708 1006 }
samux 1:80ab0d068708 1007
samux 1:80ab0d068708 1008 uint8_t * USBDevice::stringIproductDesc() {
samux 1:80ab0d068708 1009 static uint8_t stringIproductDescriptor[] = {
samux 1:80ab0d068708 1010 0x16, /*bLength*/
samux 1:80ab0d068708 1011 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1012 'U',0,'S',0,'B',0,' ',0,'D',0,'E',0,'V',0,'I',0,'C',0,'E',0 /*bString iProduct - USB DEVICE*/
samux 1:80ab0d068708 1013 };
samux 1:80ab0d068708 1014 return stringIproductDescriptor;
samux 1:80ab0d068708 1015 }