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:
Thu Jul 24 05:49:45 2014 +0000
Revision:
28:0596f144dad5
Parent:
26:8ef73dd868a0
Child:
29:b502c11a3dff
Fixed USB client connection problem on KL25Z with USB 3.0 ports on machines with Haswell chip sets (some Macs, Win 7, and Win 8).  Added SUSPEND and RESUME interrupt handling to KL25Z, with calls to suspendStateChanged().

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