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:
samux
Date:
Tue Jul 17 14:30:29 2012 +0000
Revision:
1:80ab0d068708
Child:
8:335f2506f422
Update USBDevice lib

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