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:
bogdanm
Date:
Mon Aug 05 14:13:36 2013 +0300
Revision:
11:eeb3cbbaa996
Parent:
8:335f2506f422
Child:
17:bbd6dac92961
Bug fixes, added suppor for LPC1347

Author: Samuel Mokrani

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