Version of USBDevice that works for KL25Z on Mbed OS2.
Fork of USBDevice by
USBDevice/USBDevice.cpp@1:80ab0d068708, 2012-07-17 (annotated)
- 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?
User | Revision | Line number | New 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 = ¤tAlternate; |
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 | } |