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