USB device stack, with KL25Z fixes for USB 3.0 hosts and sleep/resume interrupt handling

Dependents:   frdm_Slider_Keyboard idd_hw2_figlax_PanType idd_hw2_appachu_finger_chording idd_hw3_AngieWangAntonioDeLimaFernandesDanielLim_BladeSymphony ... more

Fork of USBDevice by mbed official

This is an overhauled version of the standard mbed USB device-side driver library, with bug fixes for KL25Z devices. It greatly improves reliability and stability of USB on the KL25Z, especially with devices using multiple endpoints concurrently.

I've had some nagging problems with the base mbed implementation for a long time, manifesting as occasional random disconnects that required rebooting the device. Recently (late 2015), I started implementing a USB device on the KL25Z that used multiple endpoints, and suddenly the nagging, occasional problems turned into frequent and predictable crashes. This forced me to delve into the USB stack and figure out what was really going on. Happily, the frequent crashes made it possible to track down and fix the problems. This new version is working very reliably in my testing - the random disconnects seem completely eradicated, even under very stressful conditions for the device.

Summary

  • Overall stability improvements
  • USB 3.0 host support
  • Stalled endpoint fixes
  • Sleep/resume notifications
  • Smaller memory footprint
  • General code cleanup

Update - 2/15/2016

My recent fixes introduced a new problem that made the initial connection fail most of the time on certain hosts. It's not clear if the common thread was a particular type of motherboard or USB chip set, or a specific version of Windows, or what, but several people ran into it. We tracked the problem down to the "stall" fixes in the earlier updates, which we now know weren't quite the right fixes after all. The latest update (2/15/2016) fixes this. It has new and improved "unstall" handling that so far works well with diverse hosts.

Race conditions and overall stability

The base mbed KL25Z implementation has a lot of problems with "race conditions" - timing problems that can happen when hardware interrupts occur at inopportune moments. The library shares a bunch of static variable data between interrupt handler context and regular application context. This isn't automatically a bad thing, but it does require careful coordination to make sure that the interrupt handler doesn't corrupt data that the other code was in the middle of updating when an interrupt occurs. The base mbed code, though, doesn't do any of the necessary coordination. This makes it kind of amazing that the base code worked at all for anyone, but I guess the interrupt rate is low enough in most applications that the glitch rate was below anyone's threshold to seriously investigate.

This overhaul adds the necessary coordination for the interrupt handlers to protect against these data corruptions. I think it's very solid now, and hopefully entirely free of the numerous race conditions in the old code. It's always hard to be certain that you've fixed every possible bug like this because they strike (effectively) at random, but I'm pretty confident: my test application was reliably able to trigger glitches in the base code in a matter of minutes, but the same application (with the overhauled library) now runs for days on end without dropping the connection.

Stalled endpoint fixes

USB has a standard way of handling communications errors called a "stall", which basically puts the connection into an error mode to let both sides know that they need to reset their internal states and sync up again. The original mbed version of the USB device library doesn't seem to have the necessary code to recover from this condition properly. The KL25Z hardware does some of the work, but it also seems to require the software to take some steps to "un-stall" the connection. (I keep saying "seems to" because the hardware reference material is very sketchy about all of this. Most of what I've figured out is from observing the device in action with a Windows host.) This new version adds code to do the necessary re-syncing and get the connection going again, automatically, and transparently to the user.

USB 3.0 Hosts

The original mbed code sometimes didn't work when connecting to hosts with USB 3.0 ports. This didn't affect every host, but it affected many of them. The common element seemed to be the Intel Haswell chip set on the host, but there may be other chip sets affected as well. In any case, the problem affected many PCs from the Windows 7 and 8 generation, as well as many Macs. It was possible to work around the problem by avoiding USB 3.0 ports - you could use a USB 2 port on the host, or plug a USB 2 hub between the host and device. But I wanted to just fix the problem and eliminate the need for such workarounds. This modified version of the library has such a fix, which so far has worked for everyone who's tried.

Sleep/resume notifications

This modified version also contains an innocuous change to the KL25Z USB HAL code to handle sleep and resume interrupts with calls to suspendStateChanged(). The original KL25Z code omitted these calls (and in fact didn't even enable the interrupts), but I think this was an unintentional oversight - the notifier function is part of the generic API, and other supported boards all implement it. I use this feature in my own application so that I can distinguish sleep mode from actual disconnects and handle the two conditions correctly.

Smaller memory footprint

The base mbed version of the code allocates twice as much memory for USB buffers as it really needed to. It looks like the original developers intended to implement the KL25Z USB hardware's built-in double-buffering mechanism, but they ultimately abandoned that effort. But they left in the double memory allocation. This version removes that and allocates only what's actually needed. The USB buffers aren't that big (128 bytes per endpoint), so this doesn't save a ton of memory, but even a little memory is pretty precious on this machine given that it only has 16K.

(I did look into adding the double-buffering support that the original developers abandoned, but after some experimentation I decided they were right to skip it. It just doesn't seem to mesh well with the design of the rest of the mbed USB code. I think it would take a major rewrite to make it work, and it doesn't seem worth the effort given that most applications don't need it - it would only benefit applications that are moving so much data through USB that they're pushing the limits of the CPU. And even for those, I think it would be a lot simpler to build a purely software-based buffer rotation mechanism.)

General code cleanup

The KL25Z HAL code in this version has greatly expanded commentary and a lot of general cleanup. Some of the hardware constants were given the wrong symbolic names (e.g., EVEN and ODD were reversed), and many were just missing (written as hard-coded numbers without explanation). I fixed the misnomers and added symbolic names for formerly anonymous numbers. Hopefully the next person who has to overhaul this code will at least have an easier time understanding what I thought I was doing!

Committer:
mjr
Date:
Tue Jan 05 05:22:50 2016 +0000
Revision:
36:20bb47609697
Parent:
34:884405d998bb
Child:
37:c5ac4ccf6597
Fix race conditions

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 {
mjr 30:2f8f4c3822a1 190 #if defined(TARGET_KL25Z) | defined(TARGET_KL46Z) | defined(TARGET_K20D5M) | defined(TARGET_K64F)
mjr 29:b502c11a3dff 191 /*
mjr 29:b502c11a3dff 192 * We seem to have a pending device-to-host transfer. The host must have
mjr 29:b502c11a3dff 193 * sent a new control request without waiting for us to finish processing
mjr 29:b502c11a3dff 194 * the previous one. This appears to happen when we're connected to certain
mjr 34:884405d998bb 195 * USB 3.0 host chip sets. Do a zero-length send to tell the host we're not
mjr 29:b502c11a3dff 196 * ready for the new request - that'll make it resend - and then just
mjr 29:b502c11a3dff 197 * pretend we were successful here so that the pending transfer can finish.
mjr 29:b502c11a3dff 198 */
mjr 36:20bb47609697 199 EP0write(0, 0);
mjr 31:81f57ea86f8f 200
mjr 36:20bb47609697 201 /* execute our pending transfer */
mjr 36:20bb47609697 202 printf("controlOut stall 1\r\n");
mjr 31:81f57ea86f8f 203 controlIn();
mjr 31:81f57ea86f8f 204
mjr 31:81f57ea86f8f 205 /* indicate success */
mjr 31:81f57ea86f8f 206 return false;
mjr 29:b502c11a3dff 207 #else
mjr 31:81f57ea86f8f 208 /* for other platforms, count on the HAL to handle this case */
mjr 31:81f57ea86f8f 209 return false;
mjr 29:b502c11a3dff 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 */
mjr 36:20bb47609697 220 printf("controlOut stall 2\r\n");
samux 1:80ab0d068708 221 return false;
samux 1:80ab0d068708 222 }
samux 1:80ab0d068708 223
samux 1:80ab0d068708 224 /* Update transfer */
samux 1:80ab0d068708 225 transfer.ptr += packetSize;
samux 1:80ab0d068708 226 transfer.remaining -= packetSize;
samux 1:80ab0d068708 227
samux 1:80ab0d068708 228 /* Check if transfer has completed */
samux 1:80ab0d068708 229 if (transfer.remaining == 0)
samux 1:80ab0d068708 230 {
samux 1:80ab0d068708 231 /* Transfer completed */
samux 1:80ab0d068708 232 if (transfer.notify)
samux 1:80ab0d068708 233 {
samux 1:80ab0d068708 234 /* Notify class layer. */
samux 1:80ab0d068708 235 USBCallback_requestCompleted(buffer, packetSize);
samux 1:80ab0d068708 236 transfer.notify = false;
samux 1:80ab0d068708 237 }
samux 1:80ab0d068708 238 /* Status stage */
samux 1:80ab0d068708 239 EP0write(NULL, 0);
samux 1:80ab0d068708 240 }
samux 1:80ab0d068708 241 else
samux 1:80ab0d068708 242 {
samux 1:80ab0d068708 243 EP0read();
samux 1:80ab0d068708 244 }
samux 1:80ab0d068708 245
samux 1:80ab0d068708 246 return true;
samux 1:80ab0d068708 247 }
samux 1:80ab0d068708 248
samux 1:80ab0d068708 249 bool USBDevice::controlIn(void)
samux 1:80ab0d068708 250 {
samux 1:80ab0d068708 251 /* Control transfer data IN stage */
samux 1:80ab0d068708 252 uint32_t packetSize;
samux 1:80ab0d068708 253
samux 1:80ab0d068708 254 /* Check if transfer has completed (status stage transactions */
samux 1:80ab0d068708 255 /* also have transfer.remaining == 0) */
samux 1:80ab0d068708 256 if (transfer.remaining == 0)
samux 1:80ab0d068708 257 {
samux 1:80ab0d068708 258 if (transfer.zlp)
samux 1:80ab0d068708 259 {
samux 1:80ab0d068708 260 /* Send zero length packet */
samux 1:80ab0d068708 261 EP0write(NULL, 0);
samux 1:80ab0d068708 262 transfer.zlp = false;
samux 1:80ab0d068708 263 }
samux 1:80ab0d068708 264
samux 1:80ab0d068708 265 /* Transfer completed */
samux 1:80ab0d068708 266 if (transfer.notify)
samux 1:80ab0d068708 267 {
samux 1:80ab0d068708 268 /* Notify class layer. */
samux 1:80ab0d068708 269 USBCallback_requestCompleted(NULL, 0);
samux 1:80ab0d068708 270 transfer.notify = false;
samux 1:80ab0d068708 271 }
samux 1:80ab0d068708 272
samux 1:80ab0d068708 273 EP0read();
samux 8:335f2506f422 274 EP0readStage();
samux 1:80ab0d068708 275
samux 1:80ab0d068708 276 /* Completed */
mjr 36:20bb47609697 277 transfer.direction = HOST_TO_DEVICE;
samux 1:80ab0d068708 278 return true;
samux 1:80ab0d068708 279 }
samux 1:80ab0d068708 280
samux 1:80ab0d068708 281 /* Check we should be transferring data IN */
samux 1:80ab0d068708 282 if (transfer.direction != DEVICE_TO_HOST)
samux 1:80ab0d068708 283 {
samux 1:80ab0d068708 284 return false;
samux 1:80ab0d068708 285 }
samux 1:80ab0d068708 286
samux 1:80ab0d068708 287 packetSize = transfer.remaining;
samux 1:80ab0d068708 288
samux 1:80ab0d068708 289 if (packetSize > MAX_PACKET_SIZE_EP0)
samux 1:80ab0d068708 290 {
samux 1:80ab0d068708 291 packetSize = MAX_PACKET_SIZE_EP0;
samux 1:80ab0d068708 292 }
samux 1:80ab0d068708 293
samux 1:80ab0d068708 294 /* Write to endpoint */
samux 1:80ab0d068708 295 EP0write(transfer.ptr, packetSize);
samux 1:80ab0d068708 296
samux 1:80ab0d068708 297 /* Update transfer */
samux 1:80ab0d068708 298 transfer.ptr += packetSize;
samux 1:80ab0d068708 299 transfer.remaining -= packetSize;
mjr 36:20bb47609697 300
mjr 36:20bb47609697 301 /* are we done? */
mjr 36:20bb47609697 302 if (transfer.remaining == 0)
mjr 36:20bb47609697 303 transfer.direction = HOST_TO_DEVICE;
samux 1:80ab0d068708 304
mjr 36:20bb47609697 305 /* success */
samux 1:80ab0d068708 306 return true;
samux 1:80ab0d068708 307 }
samux 1:80ab0d068708 308
samux 1:80ab0d068708 309 bool USBDevice::requestSetAddress(void)
samux 1:80ab0d068708 310 {
samux 1:80ab0d068708 311 /* Set the device address */
samux 1:80ab0d068708 312 setAddress(transfer.setup.wValue);
samux 1:80ab0d068708 313
samux 1:80ab0d068708 314 if (transfer.setup.wValue == 0)
samux 1:80ab0d068708 315 {
samux 1:80ab0d068708 316 device.state = DEFAULT;
samux 1:80ab0d068708 317 }
samux 1:80ab0d068708 318 else
samux 1:80ab0d068708 319 {
samux 1:80ab0d068708 320 device.state = ADDRESS;
samux 1:80ab0d068708 321 }
samux 1:80ab0d068708 322
samux 1:80ab0d068708 323 return true;
samux 1:80ab0d068708 324 }
samux 1:80ab0d068708 325
samux 1:80ab0d068708 326 bool USBDevice::requestSetConfiguration(void)
samux 1:80ab0d068708 327 {
samux 1:80ab0d068708 328
samux 1:80ab0d068708 329 device.configuration = transfer.setup.wValue;
samux 1:80ab0d068708 330 /* Set the device configuration */
samux 1:80ab0d068708 331 if (device.configuration == 0)
samux 1:80ab0d068708 332 {
samux 1:80ab0d068708 333 /* Not configured */
samux 1:80ab0d068708 334 unconfigureDevice();
samux 1:80ab0d068708 335 device.state = ADDRESS;
samux 1:80ab0d068708 336 }
samux 1:80ab0d068708 337 else
samux 1:80ab0d068708 338 {
samux 1:80ab0d068708 339 if (USBCallback_setConfiguration(device.configuration))
samux 1:80ab0d068708 340 {
samux 1:80ab0d068708 341 /* Valid configuration */
samux 1:80ab0d068708 342 configureDevice();
samux 1:80ab0d068708 343 device.state = CONFIGURED;
samux 1:80ab0d068708 344 }
samux 1:80ab0d068708 345 else
samux 1:80ab0d068708 346 {
samux 1:80ab0d068708 347 return false;
samux 1:80ab0d068708 348 }
samux 1:80ab0d068708 349 }
samux 1:80ab0d068708 350
samux 1:80ab0d068708 351 return true;
samux 1:80ab0d068708 352 }
samux 1:80ab0d068708 353
samux 1:80ab0d068708 354 bool USBDevice::requestGetConfiguration(void)
samux 1:80ab0d068708 355 {
samux 1:80ab0d068708 356 /* Send the device configuration */
samux 1:80ab0d068708 357 transfer.ptr = &device.configuration;
samux 1:80ab0d068708 358 transfer.remaining = sizeof(device.configuration);
samux 1:80ab0d068708 359 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 360 return true;
samux 1:80ab0d068708 361 }
samux 1:80ab0d068708 362
samux 1:80ab0d068708 363 bool USBDevice::requestGetInterface(void)
samux 1:80ab0d068708 364 {
samux 1:80ab0d068708 365 /* Return the selected alternate setting for an interface */
samux 1:80ab0d068708 366
samux 1:80ab0d068708 367 if (device.state != CONFIGURED)
samux 1:80ab0d068708 368 {
samux 1:80ab0d068708 369 return false;
samux 1:80ab0d068708 370 }
samux 1:80ab0d068708 371
samux 1:80ab0d068708 372 /* Send the alternate setting */
samux 1:80ab0d068708 373 transfer.setup.wIndex = currentInterface;
samux 1:80ab0d068708 374 transfer.ptr = &currentAlternate;
samux 1:80ab0d068708 375 transfer.remaining = sizeof(currentAlternate);
samux 1:80ab0d068708 376 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 377 return true;
samux 1:80ab0d068708 378 }
samux 1:80ab0d068708 379
samux 1:80ab0d068708 380 bool USBDevice::requestSetInterface(void)
samux 1:80ab0d068708 381 {
samux 1:80ab0d068708 382 bool success = false;
samux 1:80ab0d068708 383 if(USBCallback_setInterface(transfer.setup.wIndex, transfer.setup.wValue))
samux 1:80ab0d068708 384 {
samux 1:80ab0d068708 385 success = true;
samux 1:80ab0d068708 386 currentInterface = transfer.setup.wIndex;
mbed_official 25:7c72828865f3 387 currentAlternate = transfer.setup.wValue;
samux 1:80ab0d068708 388 }
samux 1:80ab0d068708 389 return success;
samux 1:80ab0d068708 390 }
samux 1:80ab0d068708 391
samux 1:80ab0d068708 392 bool USBDevice::requestSetFeature()
samux 1:80ab0d068708 393 {
samux 1:80ab0d068708 394 bool success = false;
samux 1:80ab0d068708 395
samux 1:80ab0d068708 396 if (device.state != CONFIGURED)
samux 1:80ab0d068708 397 {
samux 1:80ab0d068708 398 /* Endpoint or interface must be zero */
samux 1:80ab0d068708 399 if (transfer.setup.wIndex != 0)
samux 1:80ab0d068708 400 {
samux 1:80ab0d068708 401 return false;
samux 1:80ab0d068708 402 }
samux 1:80ab0d068708 403 }
samux 1:80ab0d068708 404
samux 1:80ab0d068708 405 switch (transfer.setup.bmRequestType.Recipient)
samux 1:80ab0d068708 406 {
samux 1:80ab0d068708 407 case DEVICE_RECIPIENT:
samux 1:80ab0d068708 408 /* TODO: Remote wakeup feature not supported */
samux 1:80ab0d068708 409 break;
samux 1:80ab0d068708 410 case ENDPOINT_RECIPIENT:
samux 1:80ab0d068708 411 if (transfer.setup.wValue == ENDPOINT_HALT)
samux 1:80ab0d068708 412 {
samux 1:80ab0d068708 413 /* TODO: We should check that the endpoint number is valid */
samux 1:80ab0d068708 414 stallEndpoint(
samux 1:80ab0d068708 415 WINDEX_TO_PHYSICAL(transfer.setup.wIndex));
samux 1:80ab0d068708 416 success = true;
samux 1:80ab0d068708 417 }
samux 1:80ab0d068708 418 break;
samux 1:80ab0d068708 419 default:
samux 1:80ab0d068708 420 break;
samux 1:80ab0d068708 421 }
samux 1:80ab0d068708 422
samux 1:80ab0d068708 423 return success;
samux 1:80ab0d068708 424 }
samux 1:80ab0d068708 425
samux 1:80ab0d068708 426 bool USBDevice::requestClearFeature()
samux 1:80ab0d068708 427 {
samux 1:80ab0d068708 428 bool success = false;
samux 1:80ab0d068708 429
samux 1:80ab0d068708 430 if (device.state != CONFIGURED)
samux 1:80ab0d068708 431 {
samux 1:80ab0d068708 432 /* Endpoint or interface must be zero */
samux 1:80ab0d068708 433 if (transfer.setup.wIndex != 0)
samux 1:80ab0d068708 434 {
samux 1:80ab0d068708 435 return false;
samux 1:80ab0d068708 436 }
samux 1:80ab0d068708 437 }
samux 1:80ab0d068708 438
samux 1:80ab0d068708 439 switch (transfer.setup.bmRequestType.Recipient)
samux 1:80ab0d068708 440 {
samux 1:80ab0d068708 441 case DEVICE_RECIPIENT:
samux 1:80ab0d068708 442 /* TODO: Remote wakeup feature not supported */
samux 1:80ab0d068708 443 break;
samux 1:80ab0d068708 444 case ENDPOINT_RECIPIENT:
samux 1:80ab0d068708 445 /* TODO: We should check that the endpoint number is valid */
samux 1:80ab0d068708 446 if (transfer.setup.wValue == ENDPOINT_HALT)
samux 1:80ab0d068708 447 {
samux 1:80ab0d068708 448 unstallEndpoint( WINDEX_TO_PHYSICAL(transfer.setup.wIndex));
samux 1:80ab0d068708 449 success = true;
samux 1:80ab0d068708 450 }
samux 1:80ab0d068708 451 break;
samux 1:80ab0d068708 452 default:
samux 1:80ab0d068708 453 break;
samux 1:80ab0d068708 454 }
samux 1:80ab0d068708 455
samux 1:80ab0d068708 456 return success;
samux 1:80ab0d068708 457 }
samux 1:80ab0d068708 458
samux 1:80ab0d068708 459 bool USBDevice::requestGetStatus(void)
samux 1:80ab0d068708 460 {
samux 1:80ab0d068708 461 static uint16_t status;
samux 1:80ab0d068708 462 bool success = false;
samux 1:80ab0d068708 463
samux 1:80ab0d068708 464 if (device.state != CONFIGURED)
samux 1:80ab0d068708 465 {
samux 1:80ab0d068708 466 /* Endpoint or interface must be zero */
samux 1:80ab0d068708 467 if (transfer.setup.wIndex != 0)
samux 1:80ab0d068708 468 {
samux 1:80ab0d068708 469 return false;
samux 1:80ab0d068708 470 }
samux 1:80ab0d068708 471 }
samux 1:80ab0d068708 472
samux 1:80ab0d068708 473 switch (transfer.setup.bmRequestType.Recipient)
samux 1:80ab0d068708 474 {
samux 1:80ab0d068708 475 case DEVICE_RECIPIENT:
samux 1:80ab0d068708 476 /* TODO: Currently only supports self powered devices */
samux 1:80ab0d068708 477 status = DEVICE_STATUS_SELF_POWERED;
samux 1:80ab0d068708 478 success = true;
samux 1:80ab0d068708 479 break;
samux 1:80ab0d068708 480 case INTERFACE_RECIPIENT:
samux 1:80ab0d068708 481 status = 0;
samux 1:80ab0d068708 482 success = true;
samux 1:80ab0d068708 483 break;
samux 1:80ab0d068708 484 case ENDPOINT_RECIPIENT:
samux 1:80ab0d068708 485 /* TODO: We should check that the endpoint number is valid */
samux 1:80ab0d068708 486 if (getEndpointStallState(
samux 1:80ab0d068708 487 WINDEX_TO_PHYSICAL(transfer.setup.wIndex)))
samux 1:80ab0d068708 488 {
samux 1:80ab0d068708 489 status = ENDPOINT_STATUS_HALT;
samux 1:80ab0d068708 490 }
samux 1:80ab0d068708 491 else
samux 1:80ab0d068708 492 {
samux 1:80ab0d068708 493 status = 0;
samux 1:80ab0d068708 494 }
samux 1:80ab0d068708 495 success = true;
samux 1:80ab0d068708 496 break;
samux 1:80ab0d068708 497 default:
samux 1:80ab0d068708 498 break;
samux 1:80ab0d068708 499 }
samux 1:80ab0d068708 500
samux 1:80ab0d068708 501 if (success)
samux 1:80ab0d068708 502 {
mbed_official 25:7c72828865f3 503 /* Send the status */
samux 1:80ab0d068708 504 transfer.ptr = (uint8_t *)&status; /* Assumes little endian */
samux 1:80ab0d068708 505 transfer.remaining = sizeof(status);
samux 1:80ab0d068708 506 transfer.direction = DEVICE_TO_HOST;
samux 1:80ab0d068708 507 }
mbed_official 25:7c72828865f3 508
samux 1:80ab0d068708 509 return success;
samux 1:80ab0d068708 510 }
samux 1:80ab0d068708 511
samux 1:80ab0d068708 512 bool USBDevice::requestSetup(void)
samux 1:80ab0d068708 513 {
samux 1:80ab0d068708 514 bool success = false;
samux 1:80ab0d068708 515
samux 1:80ab0d068708 516 /* Process standard requests */
samux 1:80ab0d068708 517 if ((transfer.setup.bmRequestType.Type == STANDARD_TYPE))
samux 1:80ab0d068708 518 {
samux 1:80ab0d068708 519 switch (transfer.setup.bRequest)
samux 1:80ab0d068708 520 {
samux 1:80ab0d068708 521 case GET_STATUS:
samux 1:80ab0d068708 522 success = requestGetStatus();
samux 1:80ab0d068708 523 break;
samux 1:80ab0d068708 524 case CLEAR_FEATURE:
samux 1:80ab0d068708 525 success = requestClearFeature();
samux 1:80ab0d068708 526 break;
samux 1:80ab0d068708 527 case SET_FEATURE:
samux 1:80ab0d068708 528 success = requestSetFeature();
samux 1:80ab0d068708 529 break;
samux 1:80ab0d068708 530 case SET_ADDRESS:
samux 1:80ab0d068708 531 success = requestSetAddress();
samux 1:80ab0d068708 532 break;
samux 1:80ab0d068708 533 case GET_DESCRIPTOR:
samux 1:80ab0d068708 534 success = requestGetDescriptor();
samux 1:80ab0d068708 535 break;
samux 1:80ab0d068708 536 case SET_DESCRIPTOR:
samux 1:80ab0d068708 537 /* TODO: Support is optional, not implemented here */
samux 1:80ab0d068708 538 success = false;
samux 1:80ab0d068708 539 break;
samux 1:80ab0d068708 540 case GET_CONFIGURATION:
samux 1:80ab0d068708 541 success = requestGetConfiguration();
samux 1:80ab0d068708 542 break;
samux 1:80ab0d068708 543 case SET_CONFIGURATION:
samux 1:80ab0d068708 544 success = requestSetConfiguration();
samux 1:80ab0d068708 545 break;
samux 1:80ab0d068708 546 case GET_INTERFACE:
samux 1:80ab0d068708 547 success = requestGetInterface();
samux 1:80ab0d068708 548 break;
samux 1:80ab0d068708 549 case SET_INTERFACE:
samux 1:80ab0d068708 550 success = requestSetInterface();
samux 1:80ab0d068708 551 break;
samux 1:80ab0d068708 552 default:
samux 1:80ab0d068708 553 break;
samux 1:80ab0d068708 554 }
samux 1:80ab0d068708 555 }
samux 1:80ab0d068708 556
samux 1:80ab0d068708 557 return success;
samux 1:80ab0d068708 558 }
samux 1:80ab0d068708 559
samux 1:80ab0d068708 560 bool USBDevice::controlSetup(void)
samux 1:80ab0d068708 561 {
samux 1:80ab0d068708 562 bool success = false;
samux 1:80ab0d068708 563
samux 1:80ab0d068708 564 /* Control transfer setup stage */
samux 1:80ab0d068708 565 uint8_t buffer[MAX_PACKET_SIZE_EP0];
samux 1:80ab0d068708 566
samux 1:80ab0d068708 567 EP0setup(buffer);
samux 1:80ab0d068708 568
samux 1:80ab0d068708 569 /* Initialise control transfer state */
samux 1:80ab0d068708 570 decodeSetupPacket(buffer, &transfer.setup);
samux 1:80ab0d068708 571 transfer.ptr = NULL;
samux 1:80ab0d068708 572 transfer.remaining = 0;
mjr 36:20bb47609697 573 transfer.direction = HOST_TO_DEVICE;
samux 1:80ab0d068708 574 transfer.zlp = false;
samux 1:80ab0d068708 575 transfer.notify = false;
mbed_official 25:7c72828865f3 576
mjr 36:20bb47609697 577 CONTROL_TRANSFER backup; memcpy(&backup, &transfer, sizeof(backup));
mjr 36:20bb47609697 578
samux 1:80ab0d068708 579 #ifdef DEBUG
samux 1:80ab0d068708 580 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 581 transfer.setup.bmRequestType.Type,
samux 1:80ab0d068708 582 transfer.setup.bmRequestType.Recipient,
samux 1:80ab0d068708 583 transfer.setup.bRequest,
samux 1:80ab0d068708 584 transfer.setup.wValue,
samux 1:80ab0d068708 585 transfer.setup.wIndex,
samux 1:80ab0d068708 586 transfer.setup.wLength);
samux 1:80ab0d068708 587 #endif
samux 1:80ab0d068708 588
samux 1:80ab0d068708 589 /* Class / vendor specific */
samux 1:80ab0d068708 590 success = USBCallback_request();
samux 1:80ab0d068708 591
samux 1:80ab0d068708 592 if (!success)
samux 1:80ab0d068708 593 {
samux 1:80ab0d068708 594 /* Standard requests */
samux 1:80ab0d068708 595 if (!requestSetup())
samux 1:80ab0d068708 596 {
mjr 36:20bb47609697 597 printf("requestSetup() failed: type=%d, req=%d\r\n", (int)transfer.setup.bmRequestType.Type, (int)transfer.setup.bRequest);//$$$
mjr 36:20bb47609697 598 if (memcmp(&backup, &transfer, sizeof(transfer))) printf("backup copy is dfferent\r\n");
samux 1:80ab0d068708 599 #ifdef DEBUG
mjr 36:20bb47609697 600 printf("requestSetup() failed\r\n");
samux 1:80ab0d068708 601 #endif
samux 1:80ab0d068708 602 return false;
samux 1:80ab0d068708 603 }
samux 1:80ab0d068708 604 }
samux 1:80ab0d068708 605
samux 1:80ab0d068708 606 /* Check transfer size and direction */
mjr 36:20bb47609697 607 if (transfer.setup.wLength > 0)
samux 1:80ab0d068708 608 {
samux 1:80ab0d068708 609 if (transfer.setup.bmRequestType.dataTransferDirection \
samux 1:80ab0d068708 610 == DEVICE_TO_HOST)
samux 1:80ab0d068708 611 {
samux 1:80ab0d068708 612 /* IN data stage is required */
samux 1:80ab0d068708 613 if (transfer.direction != DEVICE_TO_HOST)
samux 1:80ab0d068708 614 {
mjr 36:20bb47609697 615 printf("controlSetup transfer direction wrong 1\r\n");//$$$
samux 1:80ab0d068708 616 return false;
samux 1:80ab0d068708 617 }
samux 1:80ab0d068708 618
samux 1:80ab0d068708 619 /* Transfer must be less than or equal to the size */
samux 1:80ab0d068708 620 /* requested by the host */
samux 1:80ab0d068708 621 if (transfer.remaining > transfer.setup.wLength)
samux 1:80ab0d068708 622 {
samux 1:80ab0d068708 623 transfer.remaining = transfer.setup.wLength;
samux 1:80ab0d068708 624 }
samux 1:80ab0d068708 625 }
samux 1:80ab0d068708 626 else
samux 1:80ab0d068708 627 {
mbed_official 25:7c72828865f3 628
samux 1:80ab0d068708 629 /* OUT data stage is required */
samux 1:80ab0d068708 630 if (transfer.direction != HOST_TO_DEVICE)
samux 1:80ab0d068708 631 {
mjr 36:20bb47609697 632 printf("controlSetup transfer direction wrong 2: type=%d, req=%d\r\n", (int)transfer.setup.bmRequestType.Type, (int)transfer.setup.bRequest);//$$$
samux 1:80ab0d068708 633 return false;
samux 1:80ab0d068708 634 }
samux 1:80ab0d068708 635
samux 1:80ab0d068708 636 /* Transfer must be equal to the size requested by the host */
samux 1:80ab0d068708 637 if (transfer.remaining != transfer.setup.wLength)
samux 1:80ab0d068708 638 {
mjr 36:20bb47609697 639 printf("controlSetup remaining length wrong: return len=%d, type=%d, req=%d, wvalue=%d, windex=%x, wlength=%d\r\n",
mjr 36:20bb47609697 640 transfer.remaining, transfer.setup.bmRequestType.Type, transfer.setup.bRequest, transfer.setup.wValue, transfer.setup.wIndex, transfer.setup.wLength);//$$$
samux 1:80ab0d068708 641 return false;
samux 1:80ab0d068708 642 }
samux 1:80ab0d068708 643 }
samux 1:80ab0d068708 644 }
samux 1:80ab0d068708 645 else
samux 1:80ab0d068708 646 {
samux 1:80ab0d068708 647 /* No data stage; transfer size must be zero */
samux 1:80ab0d068708 648 if (transfer.remaining != 0)
samux 1:80ab0d068708 649 {
mjr 36:20bb47609697 650 printf("controlSetup remaining length must be zero: return len=%d, type=%d, req=%d, wvalue=%d, windex=%x, wlength=%d\r\n",
mjr 36:20bb47609697 651 (int)transfer.remaining, (int)transfer.setup.bmRequestType.Type, (int)transfer.setup.bRequest, (int)transfer.setup.wValue, (int)transfer.setup.wIndex, (int)transfer.setup.wLength);//$$$
samux 1:80ab0d068708 652 return false;
samux 1:80ab0d068708 653 }
samux 1:80ab0d068708 654 }
samux 1:80ab0d068708 655
samux 1:80ab0d068708 656 /* Data or status stage if applicable */
mjr 36:20bb47609697 657 if (transfer.setup.wLength > 0)
samux 1:80ab0d068708 658 {
samux 1:80ab0d068708 659 if (transfer.setup.bmRequestType.dataTransferDirection \
samux 1:80ab0d068708 660 == DEVICE_TO_HOST)
samux 1:80ab0d068708 661 {
samux 1:80ab0d068708 662 /* Check if we'll need to send a zero length packet at */
samux 1:80ab0d068708 663 /* the end of this transfer */
samux 1:80ab0d068708 664 if (transfer.setup.wLength > transfer.remaining)
samux 1:80ab0d068708 665 {
samux 1:80ab0d068708 666 /* Device wishes to transfer less than host requested */
samux 1:80ab0d068708 667 if ((transfer.remaining % MAX_PACKET_SIZE_EP0) == 0)
samux 1:80ab0d068708 668 {
samux 1:80ab0d068708 669 /* Transfer is a multiple of EP0 max packet size */
samux 1:80ab0d068708 670 transfer.zlp = true;
samux 1:80ab0d068708 671 }
samux 1:80ab0d068708 672 }
samux 1:80ab0d068708 673
samux 1:80ab0d068708 674 /* IN stage */
samux 1:80ab0d068708 675 controlIn();
samux 1:80ab0d068708 676 }
samux 1:80ab0d068708 677 else
samux 1:80ab0d068708 678 {
samux 1:80ab0d068708 679 /* OUT stage */
samux 1:80ab0d068708 680 EP0read();
samux 1:80ab0d068708 681 }
samux 1:80ab0d068708 682 }
samux 1:80ab0d068708 683 else
samux 1:80ab0d068708 684 {
samux 1:80ab0d068708 685 /* Status stage */
samux 1:80ab0d068708 686 EP0write(NULL, 0);
samux 1:80ab0d068708 687 }
samux 1:80ab0d068708 688
samux 1:80ab0d068708 689 return true;
samux 1:80ab0d068708 690 }
samux 1:80ab0d068708 691
samux 1:80ab0d068708 692 void USBDevice::busReset(void)
samux 1:80ab0d068708 693 {
samux 1:80ab0d068708 694 device.state = DEFAULT;
samux 1:80ab0d068708 695 device.configuration = 0;
samux 1:80ab0d068708 696 device.suspended = false;
samux 1:80ab0d068708 697
samux 1:80ab0d068708 698 /* Call class / vendor specific busReset function */
samux 1:80ab0d068708 699 USBCallback_busReset();
samux 1:80ab0d068708 700 }
samux 1:80ab0d068708 701
samux 1:80ab0d068708 702 void USBDevice::EP0setupCallback(void)
samux 1:80ab0d068708 703 {
samux 1:80ab0d068708 704 /* Endpoint 0 setup event */
samux 1:80ab0d068708 705 if (!controlSetup())
samux 1:80ab0d068708 706 {
samux 1:80ab0d068708 707 /* Protocol stall */
mjr 36:20bb47609697 708 printf("Ep0setup stall\r\n");
samux 1:80ab0d068708 709 EP0stall();
samux 1:80ab0d068708 710 }
samux 1:80ab0d068708 711 }
samux 1:80ab0d068708 712
samux 1:80ab0d068708 713 void USBDevice::EP0out(void)
samux 1:80ab0d068708 714 {
samux 1:80ab0d068708 715 /* Endpoint 0 OUT data event */
samux 1:80ab0d068708 716 if (!controlOut())
samux 1:80ab0d068708 717 {
mjr 29:b502c11a3dff 718 /* Protocol stall; this will stall both endpoints */
mjr 36:20bb47609697 719 printf("Ep0out stall\r\n");
samux 1:80ab0d068708 720 EP0stall();
samux 1:80ab0d068708 721 }
samux 1:80ab0d068708 722 }
samux 1:80ab0d068708 723
samux 1:80ab0d068708 724 void USBDevice::EP0in(void)
samux 1:80ab0d068708 725 {
samux 1:80ab0d068708 726 #ifdef DEBUG
samux 1:80ab0d068708 727 printf("EP0IN\r\n");
samux 1:80ab0d068708 728 #endif
samux 1:80ab0d068708 729 /* Endpoint 0 IN data event */
samux 1:80ab0d068708 730 if (!controlIn())
samux 1:80ab0d068708 731 {
samux 1:80ab0d068708 732 /* Protocol stall; this will stall both endpoints */
mjr 36:20bb47609697 733 printf("EP0in stall\r\n");
samux 1:80ab0d068708 734 EP0stall();
samux 1:80ab0d068708 735 }
samux 1:80ab0d068708 736 }
samux 1:80ab0d068708 737
samux 1:80ab0d068708 738 bool USBDevice::configured(void)
samux 1:80ab0d068708 739 {
samux 1:80ab0d068708 740 /* Returns true if device is in the CONFIGURED state */
samux 1:80ab0d068708 741 return (device.state == CONFIGURED);
samux 1:80ab0d068708 742 }
samux 1:80ab0d068708 743
mbed_official 18:78bdbce94509 744 void USBDevice::connect(bool blocking)
samux 1:80ab0d068708 745 {
samux 1:80ab0d068708 746 /* Connect device */
samux 1:80ab0d068708 747 USBHAL::connect();
mbed_official 25:7c72828865f3 748
mbed_official 18:78bdbce94509 749 if (blocking) {
mbed_official 18:78bdbce94509 750 /* Block if not configured */
mbed_official 18:78bdbce94509 751 while (!configured());
mbed_official 18:78bdbce94509 752 }
samux 1:80ab0d068708 753 }
samux 1:80ab0d068708 754
samux 1:80ab0d068708 755 void USBDevice::disconnect(void)
samux 1:80ab0d068708 756 {
samux 1:80ab0d068708 757 /* Disconnect device */
samux 1:80ab0d068708 758 USBHAL::disconnect();
mbed_official 26:8ef73dd868a0 759
mbed_official 26:8ef73dd868a0 760 /* Set initial device state */
mbed_official 26:8ef73dd868a0 761 device.state = POWERED;
mbed_official 26:8ef73dd868a0 762 device.configuration = 0;
mbed_official 26:8ef73dd868a0 763 device.suspended = false;
samux 1:80ab0d068708 764 }
samux 1:80ab0d068708 765
samux 1:80ab0d068708 766 CONTROL_TRANSFER * USBDevice::getTransferPtr(void)
samux 1:80ab0d068708 767 {
samux 1:80ab0d068708 768 return &transfer;
samux 1:80ab0d068708 769 }
samux 1:80ab0d068708 770
samux 1:80ab0d068708 771 bool USBDevice::addEndpoint(uint8_t endpoint, uint32_t maxPacket)
samux 1:80ab0d068708 772 {
samux 1:80ab0d068708 773 return realiseEndpoint(endpoint, maxPacket, 0);
samux 1:80ab0d068708 774 }
samux 1:80ab0d068708 775
samux 1:80ab0d068708 776 bool USBDevice::addRateFeedbackEndpoint(uint8_t endpoint, uint32_t maxPacket)
samux 1:80ab0d068708 777 {
samux 1:80ab0d068708 778 /* For interrupt endpoints only */
samux 1:80ab0d068708 779 return realiseEndpoint(endpoint, maxPacket, RATE_FEEDBACK_MODE);
samux 1:80ab0d068708 780 }
samux 1:80ab0d068708 781
mjr 33:b0a3f6b27b07 782 uint8_t * USBDevice::findDescriptor(uint8_t descriptorType, int idx)
samux 1:80ab0d068708 783 {
samux 1:80ab0d068708 784 /* Find a descriptor within the list of descriptors */
samux 1:80ab0d068708 785 /* following a configuration descriptor. */
samux 1:80ab0d068708 786 uint16_t wTotalLength;
samux 1:80ab0d068708 787 uint8_t *ptr;
samux 1:80ab0d068708 788
samux 1:80ab0d068708 789 if (configurationDesc() == NULL)
samux 1:80ab0d068708 790 {
samux 1:80ab0d068708 791 return NULL;
samux 1:80ab0d068708 792 }
samux 1:80ab0d068708 793
samux 1:80ab0d068708 794 /* Check this is a configuration descriptor */
samux 1:80ab0d068708 795 if ((configurationDesc()[0] != CONFIGURATION_DESCRIPTOR_LENGTH) \
samux 1:80ab0d068708 796 || (configurationDesc()[1] != CONFIGURATION_DESCRIPTOR))
samux 1:80ab0d068708 797 {
samux 1:80ab0d068708 798 return NULL;
samux 1:80ab0d068708 799 }
samux 1:80ab0d068708 800
samux 1:80ab0d068708 801 wTotalLength = configurationDesc()[2] | (configurationDesc()[3] << 8);
samux 1:80ab0d068708 802
samux 1:80ab0d068708 803 /* Check there are some more descriptors to follow */
samux 1:80ab0d068708 804 if (wTotalLength <= (CONFIGURATION_DESCRIPTOR_LENGTH+2))
samux 1:80ab0d068708 805 /* +2 is for bLength and bDescriptorType of next descriptor */
samux 1:80ab0d068708 806 {
bogdanm 11:eeb3cbbaa996 807 return NULL;
samux 1:80ab0d068708 808 }
samux 1:80ab0d068708 809
samux 1:80ab0d068708 810 /* Start at first descriptor after the configuration descriptor */
samux 1:80ab0d068708 811 ptr = &(configurationDesc()[CONFIGURATION_DESCRIPTOR_LENGTH]);
samux 1:80ab0d068708 812
samux 1:80ab0d068708 813 do {
samux 1:80ab0d068708 814 if (ptr[1] /* bDescriptorType */ == descriptorType)
samux 1:80ab0d068708 815 {
mjr 33:b0a3f6b27b07 816 // Found - if the index has reached zero, it's the one we're
mjr 33:b0a3f6b27b07 817 // looking for; if not, just decrement the index and keep looking.
mjr 33:b0a3f6b27b07 818 if (idx == 0)
mjr 33:b0a3f6b27b07 819 return ptr;
mjr 33:b0a3f6b27b07 820 else
mjr 33:b0a3f6b27b07 821 --idx;
samux 1:80ab0d068708 822 }
samux 1:80ab0d068708 823
samux 1:80ab0d068708 824 /* Skip to next descriptor */
samux 1:80ab0d068708 825 ptr += ptr[0]; /* bLength */
samux 1:80ab0d068708 826 } while (ptr < (configurationDesc() + wTotalLength));
samux 1:80ab0d068708 827
samux 1:80ab0d068708 828 /* Reached end of the descriptors - not found */
samux 1:80ab0d068708 829 return NULL;
samux 1:80ab0d068708 830 }
samux 1:80ab0d068708 831
samux 1:80ab0d068708 832
samux 1:80ab0d068708 833 void USBDevice::connectStateChanged(unsigned int connected)
samux 1:80ab0d068708 834 {
samux 1:80ab0d068708 835 }
samux 1:80ab0d068708 836
samux 1:80ab0d068708 837 void USBDevice::suspendStateChanged(unsigned int suspended)
samux 1:80ab0d068708 838 {
samux 1:80ab0d068708 839 }
samux 1:80ab0d068708 840
samux 1:80ab0d068708 841
samux 1:80ab0d068708 842 USBDevice::USBDevice(uint16_t vendor_id, uint16_t product_id, uint16_t product_release){
mbed_official 25:7c72828865f3 843 VENDOR_ID = vendor_id;
mbed_official 25:7c72828865f3 844 PRODUCT_ID = product_id;
samux 1:80ab0d068708 845 PRODUCT_RELEASE = product_release;
samux 1:80ab0d068708 846
samux 1:80ab0d068708 847 /* Set initial device state */
samux 1:80ab0d068708 848 device.state = POWERED;
samux 1:80ab0d068708 849 device.configuration = 0;
samux 1:80ab0d068708 850 device.suspended = false;
samux 1:80ab0d068708 851 };
samux 1:80ab0d068708 852
samux 1:80ab0d068708 853
samux 1:80ab0d068708 854 bool USBDevice::readStart(uint8_t endpoint, uint32_t maxSize)
samux 1:80ab0d068708 855 {
samux 1:80ab0d068708 856 return endpointRead(endpoint, maxSize) == EP_PENDING;
samux 1:80ab0d068708 857 }
samux 1:80ab0d068708 858
samux 1:80ab0d068708 859
samux 1:80ab0d068708 860 bool USBDevice::write(uint8_t endpoint, uint8_t * buffer, uint32_t size, uint32_t maxSize)
samux 1:80ab0d068708 861 {
samux 1:80ab0d068708 862 EP_STATUS result;
samux 1:80ab0d068708 863
samux 1:80ab0d068708 864 if (size > maxSize)
samux 1:80ab0d068708 865 {
samux 1:80ab0d068708 866 return false;
samux 1:80ab0d068708 867 }
mbed_official 25:7c72828865f3 868
mbed_official 25:7c72828865f3 869
samux 1:80ab0d068708 870 if(!configured()) {
samux 1:80ab0d068708 871 return false;
samux 1:80ab0d068708 872 }
mbed_official 25:7c72828865f3 873
samux 1:80ab0d068708 874 /* Send report */
mjr 34:884405d998bb 875 do {
mjr 34:884405d998bb 876 result = endpointWrite(endpoint, buffer, size);
mjr 34:884405d998bb 877 } while ((result == EP_BUSY) && configured());
samux 1:80ab0d068708 878
samux 1:80ab0d068708 879 if (result != EP_PENDING)
samux 1:80ab0d068708 880 {
samux 1:80ab0d068708 881 return false;
samux 1:80ab0d068708 882 }
samux 1:80ab0d068708 883
samux 1:80ab0d068708 884 /* Wait for completion */
samux 1:80ab0d068708 885 do {
samux 1:80ab0d068708 886 result = endpointWriteResult(endpoint);
samux 1:80ab0d068708 887 } while ((result == EP_PENDING) && configured());
samux 1:80ab0d068708 888
samux 1:80ab0d068708 889 return (result == EP_COMPLETED);
samux 1:80ab0d068708 890 }
samux 1:80ab0d068708 891
samux 1:80ab0d068708 892
samux 1:80ab0d068708 893 bool USBDevice::writeNB(uint8_t endpoint, uint8_t * buffer, uint32_t size, uint32_t maxSize)
samux 1:80ab0d068708 894 {
samux 1:80ab0d068708 895 EP_STATUS result;
samux 1:80ab0d068708 896
samux 1:80ab0d068708 897 if (size > maxSize)
samux 1:80ab0d068708 898 {
samux 1:80ab0d068708 899 return false;
samux 1:80ab0d068708 900 }
mbed_official 25:7c72828865f3 901
samux 1:80ab0d068708 902 if(!configured()) {
samux 1:80ab0d068708 903 return false;
samux 1:80ab0d068708 904 }
samux 1:80ab0d068708 905
samux 1:80ab0d068708 906 /* Send report */
samux 1:80ab0d068708 907 result = endpointWrite(endpoint, buffer, size);
samux 1:80ab0d068708 908
samux 1:80ab0d068708 909 if (result != EP_PENDING)
samux 1:80ab0d068708 910 {
samux 1:80ab0d068708 911 return false;
samux 1:80ab0d068708 912 }
samux 1:80ab0d068708 913
samux 1:80ab0d068708 914 result = endpointWriteResult(endpoint);
samux 1:80ab0d068708 915
samux 1:80ab0d068708 916 return (result == EP_COMPLETED);
samux 1:80ab0d068708 917 }
samux 1:80ab0d068708 918
mjr 32:a8eb758f4074 919 bool USBDevice::writeTO(uint8_t endpoint, uint8_t * buffer, uint32_t size, uint32_t maxSize, int timeout_ms)
mjr 32:a8eb758f4074 920 {
mjr 32:a8eb758f4074 921 EP_STATUS result;
mjr 32:a8eb758f4074 922
mjr 32:a8eb758f4074 923 if (size > maxSize)
mjr 32:a8eb758f4074 924 {
mjr 32:a8eb758f4074 925 return false;
mjr 32:a8eb758f4074 926 }
mjr 32:a8eb758f4074 927
mjr 32:a8eb758f4074 928
mjr 32:a8eb758f4074 929 if(!configured()) {
mjr 32:a8eb758f4074 930 return false;
mjr 32:a8eb758f4074 931 }
mjr 34:884405d998bb 932
mjr 34:884405d998bb 933 /* set up a timer for monitoring the timeout period */
mjr 34:884405d998bb 934 Timer t;
mjr 34:884405d998bb 935 t.start();
mjr 32:a8eb758f4074 936
mjr 32:a8eb758f4074 937 /* Send report */
mjr 34:884405d998bb 938 do {
mjr 34:884405d998bb 939 result = endpointWrite(endpoint, buffer, size);
mjr 34:884405d998bb 940 } while ((result == EP_BUSY) && configured() && t.read_ms() < timeout_ms);
mjr 34:884405d998bb 941
mjr 32:a8eb758f4074 942 if (result != EP_PENDING)
mjr 32:a8eb758f4074 943 {
mjr 32:a8eb758f4074 944 return false;
mjr 32:a8eb758f4074 945 }
mjr 32:a8eb758f4074 946
mjr 32:a8eb758f4074 947 /* Wait for completion or timeout */
mjr 32:a8eb758f4074 948 do {
mjr 32:a8eb758f4074 949 result = endpointWriteResult(endpoint);
mjr 32:a8eb758f4074 950 } while ((result == EP_PENDING) && configured() && t.read_ms() < timeout_ms);
mjr 32:a8eb758f4074 951
mjr 32:a8eb758f4074 952 return (result == EP_COMPLETED);
mjr 32:a8eb758f4074 953 }
mjr 32:a8eb758f4074 954
samux 1:80ab0d068708 955 bool USBDevice::readEP(uint8_t endpoint, uint8_t * buffer, uint32_t * size, uint32_t maxSize)
samux 1:80ab0d068708 956 {
samux 1:80ab0d068708 957 EP_STATUS result;
mbed_official 25:7c72828865f3 958
samux 1:80ab0d068708 959 if(!configured()) {
samux 1:80ab0d068708 960 return false;
samux 1:80ab0d068708 961 }
samux 1:80ab0d068708 962
samux 1:80ab0d068708 963 /* Wait for completion */
samux 1:80ab0d068708 964 do {
samux 1:80ab0d068708 965 result = endpointReadResult(endpoint, buffer, size);
samux 1:80ab0d068708 966 } while ((result == EP_PENDING) && configured());
samux 1:80ab0d068708 967
samux 1:80ab0d068708 968 return (result == EP_COMPLETED);
samux 1:80ab0d068708 969 }
samux 1:80ab0d068708 970
samux 1:80ab0d068708 971
samux 1:80ab0d068708 972 bool USBDevice::readEP_NB(uint8_t endpoint, uint8_t * buffer, uint32_t * size, uint32_t maxSize)
samux 1:80ab0d068708 973 {
samux 1:80ab0d068708 974 EP_STATUS result;
mbed_official 25:7c72828865f3 975
samux 1:80ab0d068708 976 if(!configured()) {
samux 1:80ab0d068708 977 return false;
samux 1:80ab0d068708 978 }
samux 1:80ab0d068708 979
samux 1:80ab0d068708 980 result = endpointReadResult(endpoint, buffer, size);
mbed_official 25:7c72828865f3 981
samux 1:80ab0d068708 982 return (result == EP_COMPLETED);
samux 1:80ab0d068708 983 }
samux 1:80ab0d068708 984
samux 1:80ab0d068708 985
samux 1:80ab0d068708 986
samux 1:80ab0d068708 987 uint8_t * USBDevice::deviceDesc() {
samux 1:80ab0d068708 988 static uint8_t deviceDescriptor[] = {
samux 1:80ab0d068708 989 DEVICE_DESCRIPTOR_LENGTH, /* bLength */
samux 1:80ab0d068708 990 DEVICE_DESCRIPTOR, /* bDescriptorType */
samux 1:80ab0d068708 991 LSB(USB_VERSION_2_0), /* bcdUSB (LSB) */
samux 1:80ab0d068708 992 MSB(USB_VERSION_2_0), /* bcdUSB (MSB) */
samux 1:80ab0d068708 993 0x00, /* bDeviceClass */
samux 1:80ab0d068708 994 0x00, /* bDeviceSubClass */
samux 1:80ab0d068708 995 0x00, /* bDeviceprotocol */
samux 1:80ab0d068708 996 MAX_PACKET_SIZE_EP0, /* bMaxPacketSize0 */
bogdanm 11:eeb3cbbaa996 997 (uint8_t)(LSB(VENDOR_ID)), /* idVendor (LSB) */
bogdanm 11:eeb3cbbaa996 998 (uint8_t)(MSB(VENDOR_ID)), /* idVendor (MSB) */
bogdanm 11:eeb3cbbaa996 999 (uint8_t)(LSB(PRODUCT_ID)), /* idProduct (LSB) */
bogdanm 11:eeb3cbbaa996 1000 (uint8_t)(MSB(PRODUCT_ID)), /* idProduct (MSB) */
bogdanm 11:eeb3cbbaa996 1001 (uint8_t)(LSB(PRODUCT_RELEASE)), /* bcdDevice (LSB) */
bogdanm 11:eeb3cbbaa996 1002 (uint8_t)(MSB(PRODUCT_RELEASE)), /* bcdDevice (MSB) */
samux 1:80ab0d068708 1003 STRING_OFFSET_IMANUFACTURER, /* iManufacturer */
samux 1:80ab0d068708 1004 STRING_OFFSET_IPRODUCT, /* iProduct */
samux 1:80ab0d068708 1005 STRING_OFFSET_ISERIAL, /* iSerialNumber */
samux 1:80ab0d068708 1006 0x01 /* bNumConfigurations */
samux 1:80ab0d068708 1007 };
samux 1:80ab0d068708 1008 return deviceDescriptor;
samux 1:80ab0d068708 1009 }
samux 1:80ab0d068708 1010
samux 1:80ab0d068708 1011 uint8_t * USBDevice::stringLangidDesc() {
samux 1:80ab0d068708 1012 static uint8_t stringLangidDescriptor[] = {
samux 1:80ab0d068708 1013 0x04, /*bLength*/
samux 1:80ab0d068708 1014 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
mbed_official 17:bbd6dac92961 1015 0x09,0x04, /*bString Lang ID - 0x0409 - English*/
samux 1:80ab0d068708 1016 };
samux 1:80ab0d068708 1017 return stringLangidDescriptor;
samux 1:80ab0d068708 1018 }
samux 1:80ab0d068708 1019
samux 1:80ab0d068708 1020 uint8_t * USBDevice::stringImanufacturerDesc() {
samux 1:80ab0d068708 1021 static uint8_t stringImanufacturerDescriptor[] = {
samux 1:80ab0d068708 1022 0x12, /*bLength*/
samux 1:80ab0d068708 1023 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1024 'm',0,'b',0,'e',0,'d',0,'.',0,'o',0,'r',0,'g',0, /*bString iManufacturer - mbed.org*/
samux 1:80ab0d068708 1025 };
samux 1:80ab0d068708 1026 return stringImanufacturerDescriptor;
samux 1:80ab0d068708 1027 }
samux 1:80ab0d068708 1028
samux 1:80ab0d068708 1029 uint8_t * USBDevice::stringIserialDesc() {
samux 1:80ab0d068708 1030 static uint8_t stringIserialDescriptor[] = {
samux 1:80ab0d068708 1031 0x16, /*bLength*/
samux 1:80ab0d068708 1032 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1033 '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 1034 };
samux 1:80ab0d068708 1035 return stringIserialDescriptor;
samux 1:80ab0d068708 1036 }
samux 1:80ab0d068708 1037
samux 1:80ab0d068708 1038 uint8_t * USBDevice::stringIConfigurationDesc() {
samux 1:80ab0d068708 1039 static uint8_t stringIconfigurationDescriptor[] = {
samux 1:80ab0d068708 1040 0x06, /*bLength*/
samux 1:80ab0d068708 1041 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1042 '0',0,'1',0, /*bString iConfiguration - 01*/
samux 1:80ab0d068708 1043 };
samux 1:80ab0d068708 1044 return stringIconfigurationDescriptor;
samux 1:80ab0d068708 1045 }
samux 1:80ab0d068708 1046
samux 1:80ab0d068708 1047 uint8_t * USBDevice::stringIinterfaceDesc() {
samux 1:80ab0d068708 1048 static uint8_t stringIinterfaceDescriptor[] = {
samux 1:80ab0d068708 1049 0x08, /*bLength*/
samux 1:80ab0d068708 1050 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1051 'U',0,'S',0,'B',0, /*bString iInterface - USB*/
samux 1:80ab0d068708 1052 };
samux 1:80ab0d068708 1053 return stringIinterfaceDescriptor;
samux 1:80ab0d068708 1054 }
samux 1:80ab0d068708 1055
samux 1:80ab0d068708 1056 uint8_t * USBDevice::stringIproductDesc() {
samux 1:80ab0d068708 1057 static uint8_t stringIproductDescriptor[] = {
samux 1:80ab0d068708 1058 0x16, /*bLength*/
samux 1:80ab0d068708 1059 STRING_DESCRIPTOR, /*bDescriptorType 0x03*/
samux 1:80ab0d068708 1060 '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 1061 };
samux 1:80ab0d068708 1062 return stringIproductDescriptor;
samux 1:80ab0d068708 1063 }