Piotr Woźniak / Mbed 2 deprecated KL46Z-Lab2_fullll

blablabla

Dependencies:   MAG3110 MMA8451Q SLCD- TSI USBDevice mbed

USBDevice/USBMSD/USBMSD.cpp@0:339b7abfa147, 2014-04-16 (annotated)

Committer:
Osator
Date:
Wed Apr 16 12:20:00 2014 +0000
Revision:
0:339b7abfa147
blablabla

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Osator 0:339b7abfa147 1 /* Copyright (c) 2010-2011 mbed.org, MIT License
Osator 0:339b7abfa147 2 *
Osator 0:339b7abfa147 3 * Permission is hereby granted, free of charge, to any person obtaining a copy of this software
Osator 0:339b7abfa147 4 * and associated documentation files (the "Software"), to deal in the Software without
Osator 0:339b7abfa147 5 * restriction, including without limitation the rights to use, copy, modify, merge, publish,
Osator 0:339b7abfa147 6 * distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
Osator 0:339b7abfa147 7 * Software is furnished to do so, subject to the following conditions:
Osator 0:339b7abfa147 8 *
Osator 0:339b7abfa147 9 * The above copyright notice and this permission notice shall be included in all copies or
Osator 0:339b7abfa147 10 * substantial portions of the Software.
Osator 0:339b7abfa147 11 *
Osator 0:339b7abfa147 12 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
Osator 0:339b7abfa147 13 * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
Osator 0:339b7abfa147 14 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
Osator 0:339b7abfa147 15 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
Osator 0:339b7abfa147 16 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
Osator 0:339b7abfa147 17 */
Osator 0:339b7abfa147 18
Osator 0:339b7abfa147 19 #include "stdint.h"
Osator 0:339b7abfa147 20 #include "USBMSD.h"
Osator 0:339b7abfa147 21
Osator 0:339b7abfa147 22 #define DISK_OK 0x00
Osator 0:339b7abfa147 23 #define NO_INIT 0x01
Osator 0:339b7abfa147 24 #define NO_DISK 0x02
Osator 0:339b7abfa147 25 #define WRITE_PROTECT 0x04
Osator 0:339b7abfa147 26
Osator 0:339b7abfa147 27 #define CBW_Signature 0x43425355
Osator 0:339b7abfa147 28 #define CSW_Signature 0x53425355
Osator 0:339b7abfa147 29
Osator 0:339b7abfa147 30 // SCSI Commands
Osator 0:339b7abfa147 31 #define TEST_UNIT_READY 0x00
Osator 0:339b7abfa147 32 #define REQUEST_SENSE 0x03
Osator 0:339b7abfa147 33 #define FORMAT_UNIT 0x04
Osator 0:339b7abfa147 34 #define INQUIRY 0x12
Osator 0:339b7abfa147 35 #define MODE_SELECT6 0x15
Osator 0:339b7abfa147 36 #define MODE_SENSE6 0x1A
Osator 0:339b7abfa147 37 #define START_STOP_UNIT 0x1B
Osator 0:339b7abfa147 38 #define MEDIA_REMOVAL 0x1E
Osator 0:339b7abfa147 39 #define READ_FORMAT_CAPACITIES 0x23
Osator 0:339b7abfa147 40 #define READ_CAPACITY 0x25
Osator 0:339b7abfa147 41 #define READ10 0x28
Osator 0:339b7abfa147 42 #define WRITE10 0x2A
Osator 0:339b7abfa147 43 #define VERIFY10 0x2F
Osator 0:339b7abfa147 44 #define READ12 0xA8
Osator 0:339b7abfa147 45 #define WRITE12 0xAA
Osator 0:339b7abfa147 46 #define MODE_SELECT10 0x55
Osator 0:339b7abfa147 47 #define MODE_SENSE10 0x5A
Osator 0:339b7abfa147 48
Osator 0:339b7abfa147 49 // MSC class specific requests
Osator 0:339b7abfa147 50 #define MSC_REQUEST_RESET 0xFF
Osator 0:339b7abfa147 51 #define MSC_REQUEST_GET_MAX_LUN 0xFE
Osator 0:339b7abfa147 52
Osator 0:339b7abfa147 53 #define DEFAULT_CONFIGURATION (1)
Osator 0:339b7abfa147 54
Osator 0:339b7abfa147 55 // max packet size
Osator 0:339b7abfa147 56 #define MAX_PACKET MAX_PACKET_SIZE_EPBULK
Osator 0:339b7abfa147 57
Osator 0:339b7abfa147 58 // CSW Status
Osator 0:339b7abfa147 59 enum Status {
Osator 0:339b7abfa147 60 CSW_PASSED,
Osator 0:339b7abfa147 61 CSW_FAILED,
Osator 0:339b7abfa147 62 CSW_ERROR,
Osator 0:339b7abfa147 63 };
Osator 0:339b7abfa147 64
Osator 0:339b7abfa147 65
Osator 0:339b7abfa147 66 USBMSD::USBMSD(uint16_t vendor_id, uint16_t product_id, uint16_t product_release): USBDevice(vendor_id, product_id, product_release) {
Osator 0:339b7abfa147 67 stage = READ_CBW;
Osator 0:339b7abfa147 68 memset((void *)&cbw, 0, sizeof(CBW));
Osator 0:339b7abfa147 69 memset((void *)&csw, 0, sizeof(CSW));
Osator 0:339b7abfa147 70 page = NULL;
Osator 0:339b7abfa147 71 }
Osator 0:339b7abfa147 72
Osator 0:339b7abfa147 73 USBMSD::~USBMSD() {
Osator 0:339b7abfa147 74 disconnect();
Osator 0:339b7abfa147 75 }
Osator 0:339b7abfa147 76
Osator 0:339b7abfa147 77
Osator 0:339b7abfa147 78 // Called in ISR context to process a class specific request
Osator 0:339b7abfa147 79 bool USBMSD::USBCallback_request(void) {
Osator 0:339b7abfa147 80
Osator 0:339b7abfa147 81 bool success = false;
Osator 0:339b7abfa147 82 CONTROL_TRANSFER * transfer = getTransferPtr();
Osator 0:339b7abfa147 83 static uint8_t maxLUN[1] = {0};
Osator 0:339b7abfa147 84
Osator 0:339b7abfa147 85 if (transfer->setup.bmRequestType.Type == CLASS_TYPE) {
Osator 0:339b7abfa147 86 switch (transfer->setup.bRequest) {
Osator 0:339b7abfa147 87 case MSC_REQUEST_RESET:
Osator 0:339b7abfa147 88 reset();
Osator 0:339b7abfa147 89 success = true;
Osator 0:339b7abfa147 90 break;
Osator 0:339b7abfa147 91 case MSC_REQUEST_GET_MAX_LUN:
Osator 0:339b7abfa147 92 transfer->remaining = 1;
Osator 0:339b7abfa147 93 transfer->ptr = maxLUN;
Osator 0:339b7abfa147 94 transfer->direction = DEVICE_TO_HOST;
Osator 0:339b7abfa147 95 success = true;
Osator 0:339b7abfa147 96 break;
Osator 0:339b7abfa147 97 default:
Osator 0:339b7abfa147 98 break;
Osator 0:339b7abfa147 99 }
Osator 0:339b7abfa147 100 }
Osator 0:339b7abfa147 101
Osator 0:339b7abfa147 102 return success;
Osator 0:339b7abfa147 103 }
Osator 0:339b7abfa147 104
Osator 0:339b7abfa147 105
Osator 0:339b7abfa147 106 bool USBMSD::connect(bool blocking) {
Osator 0:339b7abfa147 107 //disk initialization
Osator 0:339b7abfa147 108 if (disk_status() & NO_INIT) {
Osator 0:339b7abfa147 109 if (disk_initialize()) {
Osator 0:339b7abfa147 110 return false;
Osator 0:339b7abfa147 111 }
Osator 0:339b7abfa147 112 }
Osator 0:339b7abfa147 113
Osator 0:339b7abfa147 114 // get number of blocks
Osator 0:339b7abfa147 115 BlockCount = disk_sectors();
Osator 0:339b7abfa147 116
Osator 0:339b7abfa147 117 // get memory size
Osator 0:339b7abfa147 118 MemorySize = disk_size();
Osator 0:339b7abfa147 119
Osator 0:339b7abfa147 120 if (BlockCount > 0) {
Osator 0:339b7abfa147 121 BlockSize = MemorySize / BlockCount;
Osator 0:339b7abfa147 122 if (BlockSize != 0) {
Osator 0:339b7abfa147 123 free(page);
Osator 0:339b7abfa147 124 page = (uint8_t *)malloc(BlockSize * sizeof(uint8_t));
Osator 0:339b7abfa147 125 if (page == NULL)
Osator 0:339b7abfa147 126 return false;
Osator 0:339b7abfa147 127 }
Osator 0:339b7abfa147 128 } else {
Osator 0:339b7abfa147 129 return false;
Osator 0:339b7abfa147 130 }
Osator 0:339b7abfa147 131
Osator 0:339b7abfa147 132 //connect the device
Osator 0:339b7abfa147 133 USBDevice::connect(blocking);
Osator 0:339b7abfa147 134 return true;
Osator 0:339b7abfa147 135 }
Osator 0:339b7abfa147 136
Osator 0:339b7abfa147 137 void USBMSD::disconnect() {
Osator 0:339b7abfa147 138 //De-allocate MSD page size:
Osator 0:339b7abfa147 139 free(page);
Osator 0:339b7abfa147 140 page = NULL;
Osator 0:339b7abfa147 141 USBDevice::disconnect();
Osator 0:339b7abfa147 142 }
Osator 0:339b7abfa147 143
Osator 0:339b7abfa147 144 void USBMSD::reset() {
Osator 0:339b7abfa147 145 stage = READ_CBW;
Osator 0:339b7abfa147 146 }
Osator 0:339b7abfa147 147
Osator 0:339b7abfa147 148
Osator 0:339b7abfa147 149 // Called in ISR context called when a data is received
Osator 0:339b7abfa147 150 bool USBMSD::EP2_OUT_callback() {
Osator 0:339b7abfa147 151 uint32_t size = 0;
Osator 0:339b7abfa147 152 uint8_t buf[MAX_PACKET_SIZE_EPBULK];
Osator 0:339b7abfa147 153 readEP(EPBULK_OUT, buf, &size, MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 154 switch (stage) {
Osator 0:339b7abfa147 155 // the device has to decode the CBW received
Osator 0:339b7abfa147 156 case READ_CBW:
Osator 0:339b7abfa147 157 CBWDecode(buf, size);
Osator 0:339b7abfa147 158 break;
Osator 0:339b7abfa147 159
Osator 0:339b7abfa147 160 // the device has to receive data from the host
Osator 0:339b7abfa147 161 case PROCESS_CBW:
Osator 0:339b7abfa147 162 switch (cbw.CB[0]) {
Osator 0:339b7abfa147 163 case WRITE10:
Osator 0:339b7abfa147 164 case WRITE12:
Osator 0:339b7abfa147 165 memoryWrite(buf, size);
Osator 0:339b7abfa147 166 break;
Osator 0:339b7abfa147 167 case VERIFY10:
Osator 0:339b7abfa147 168 memoryVerify(buf, size);
Osator 0:339b7abfa147 169 break;
Osator 0:339b7abfa147 170 }
Osator 0:339b7abfa147 171 break;
Osator 0:339b7abfa147 172
Osator 0:339b7abfa147 173 // an error has occured: stall endpoint and send CSW
Osator 0:339b7abfa147 174 default:
Osator 0:339b7abfa147 175 stallEndpoint(EPBULK_OUT);
Osator 0:339b7abfa147 176 csw.Status = CSW_ERROR;
Osator 0:339b7abfa147 177 sendCSW();
Osator 0:339b7abfa147 178 break;
Osator 0:339b7abfa147 179 }
Osator 0:339b7abfa147 180
Osator 0:339b7abfa147 181 //reactivate readings on the OUT bulk endpoint
Osator 0:339b7abfa147 182 readStart(EPBULK_OUT, MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 183 return true;
Osator 0:339b7abfa147 184 }
Osator 0:339b7abfa147 185
Osator 0:339b7abfa147 186 // Called in ISR context when a data has been transferred
Osator 0:339b7abfa147 187 bool USBMSD::EP2_IN_callback() {
Osator 0:339b7abfa147 188 switch (stage) {
Osator 0:339b7abfa147 189
Osator 0:339b7abfa147 190 // the device has to send data to the host
Osator 0:339b7abfa147 191 case PROCESS_CBW:
Osator 0:339b7abfa147 192 switch (cbw.CB[0]) {
Osator 0:339b7abfa147 193 case READ10:
Osator 0:339b7abfa147 194 case READ12:
Osator 0:339b7abfa147 195 memoryRead();
Osator 0:339b7abfa147 196 break;
Osator 0:339b7abfa147 197 }
Osator 0:339b7abfa147 198 break;
Osator 0:339b7abfa147 199
Osator 0:339b7abfa147 200 //the device has to send a CSW
Osator 0:339b7abfa147 201 case SEND_CSW:
Osator 0:339b7abfa147 202 sendCSW();
Osator 0:339b7abfa147 203 break;
Osator 0:339b7abfa147 204
Osator 0:339b7abfa147 205 // the host has received the CSW -> we wait a CBW
Osator 0:339b7abfa147 206 case WAIT_CSW:
Osator 0:339b7abfa147 207 stage = READ_CBW;
Osator 0:339b7abfa147 208 break;
Osator 0:339b7abfa147 209
Osator 0:339b7abfa147 210 // an error has occured
Osator 0:339b7abfa147 211 default:
Osator 0:339b7abfa147 212 stallEndpoint(EPBULK_IN);
Osator 0:339b7abfa147 213 sendCSW();
Osator 0:339b7abfa147 214 break;
Osator 0:339b7abfa147 215 }
Osator 0:339b7abfa147 216 return true;
Osator 0:339b7abfa147 217 }
Osator 0:339b7abfa147 218
Osator 0:339b7abfa147 219
Osator 0:339b7abfa147 220 void USBMSD::memoryWrite (uint8_t * buf, uint16_t size) {
Osator 0:339b7abfa147 221
Osator 0:339b7abfa147 222 if ((addr + size) > MemorySize) {
Osator 0:339b7abfa147 223 size = MemorySize - addr;
Osator 0:339b7abfa147 224 stage = ERROR;
Osator 0:339b7abfa147 225 stallEndpoint(EPBULK_OUT);
Osator 0:339b7abfa147 226 }
Osator 0:339b7abfa147 227
Osator 0:339b7abfa147 228 // we fill an array in RAM of 1 block before writing it in memory
Osator 0:339b7abfa147 229 for (int i = 0; i < size; i++)
Osator 0:339b7abfa147 230 page[addr%BlockSize + i] = buf[i];
Osator 0:339b7abfa147 231
Osator 0:339b7abfa147 232 // if the array is filled, write it in memory
Osator 0:339b7abfa147 233 if (!((addr + size)%BlockSize)) {
Osator 0:339b7abfa147 234 if (!(disk_status() & WRITE_PROTECT)) {
Osator 0:339b7abfa147 235 disk_write(page, addr/BlockSize);
Osator 0:339b7abfa147 236 }
Osator 0:339b7abfa147 237 }
Osator 0:339b7abfa147 238
Osator 0:339b7abfa147 239 addr += size;
Osator 0:339b7abfa147 240 length -= size;
Osator 0:339b7abfa147 241 csw.DataResidue -= size;
Osator 0:339b7abfa147 242
Osator 0:339b7abfa147 243 if ((!length) || (stage != PROCESS_CBW)) {
Osator 0:339b7abfa147 244 csw.Status = (stage == ERROR) ? CSW_FAILED : CSW_PASSED;
Osator 0:339b7abfa147 245 sendCSW();
Osator 0:339b7abfa147 246 }
Osator 0:339b7abfa147 247 }
Osator 0:339b7abfa147 248
Osator 0:339b7abfa147 249 void USBMSD::memoryVerify (uint8_t * buf, uint16_t size) {
Osator 0:339b7abfa147 250 uint32_t n;
Osator 0:339b7abfa147 251
Osator 0:339b7abfa147 252 if ((addr + size) > MemorySize) {
Osator 0:339b7abfa147 253 size = MemorySize - addr;
Osator 0:339b7abfa147 254 stage = ERROR;
Osator 0:339b7abfa147 255 stallEndpoint(EPBULK_OUT);
Osator 0:339b7abfa147 256 }
Osator 0:339b7abfa147 257
Osator 0:339b7abfa147 258 // beginning of a new block -> load a whole block in RAM
Osator 0:339b7abfa147 259 if (!(addr%BlockSize))
Osator 0:339b7abfa147 260 disk_read(page, addr/BlockSize);
Osator 0:339b7abfa147 261
Osator 0:339b7abfa147 262 // info are in RAM -> no need to re-read memory
Osator 0:339b7abfa147 263 for (n = 0; n < size; n++) {
Osator 0:339b7abfa147 264 if (page[addr%BlockSize + n] != buf[n]) {
Osator 0:339b7abfa147 265 memOK = false;
Osator 0:339b7abfa147 266 break;
Osator 0:339b7abfa147 267 }
Osator 0:339b7abfa147 268 }
Osator 0:339b7abfa147 269
Osator 0:339b7abfa147 270 addr += size;
Osator 0:339b7abfa147 271 length -= size;
Osator 0:339b7abfa147 272 csw.DataResidue -= size;
Osator 0:339b7abfa147 273
Osator 0:339b7abfa147 274 if ( !length || (stage != PROCESS_CBW)) {
Osator 0:339b7abfa147 275 csw.Status = (memOK && (stage == PROCESS_CBW)) ? CSW_PASSED : CSW_FAILED;
Osator 0:339b7abfa147 276 sendCSW();
Osator 0:339b7abfa147 277 }
Osator 0:339b7abfa147 278 }
Osator 0:339b7abfa147 279
Osator 0:339b7abfa147 280
Osator 0:339b7abfa147 281 bool USBMSD::inquiryRequest (void) {
Osator 0:339b7abfa147 282 uint8_t inquiry[] = { 0x00, 0x80, 0x00, 0x01,
Osator 0:339b7abfa147 283 36 - 4, 0x80, 0x00, 0x00,
Osator 0:339b7abfa147 284 'M', 'B', 'E', 'D', '.', 'O', 'R', 'G',
Osator 0:339b7abfa147 285 'M', 'B', 'E', 'D', ' ', 'U', 'S', 'B', ' ', 'D', 'I', 'S', 'K', ' ', ' ', ' ',
Osator 0:339b7abfa147 286 '1', '.', '0', ' ',
Osator 0:339b7abfa147 287 };
Osator 0:339b7abfa147 288 if (!write(inquiry, sizeof(inquiry))) {
Osator 0:339b7abfa147 289 return false;
Osator 0:339b7abfa147 290 }
Osator 0:339b7abfa147 291 return true;
Osator 0:339b7abfa147 292 }
Osator 0:339b7abfa147 293
Osator 0:339b7abfa147 294
Osator 0:339b7abfa147 295 bool USBMSD::readFormatCapacity() {
Osator 0:339b7abfa147 296 uint8_t capacity[] = { 0x00, 0x00, 0x00, 0x08,
Osator 0:339b7abfa147 297 (uint8_t)((BlockCount >> 24) & 0xff),
Osator 0:339b7abfa147 298 (uint8_t)((BlockCount >> 16) & 0xff),
Osator 0:339b7abfa147 299 (uint8_t)((BlockCount >> 8) & 0xff),
Osator 0:339b7abfa147 300 (uint8_t)((BlockCount >> 0) & 0xff),
Osator 0:339b7abfa147 301
Osator 0:339b7abfa147 302 0x02,
Osator 0:339b7abfa147 303 (uint8_t)((BlockSize >> 16) & 0xff),
Osator 0:339b7abfa147 304 (uint8_t)((BlockSize >> 8) & 0xff),
Osator 0:339b7abfa147 305 (uint8_t)((BlockSize >> 0) & 0xff),
Osator 0:339b7abfa147 306 };
Osator 0:339b7abfa147 307 if (!write(capacity, sizeof(capacity))) {
Osator 0:339b7abfa147 308 return false;
Osator 0:339b7abfa147 309 }
Osator 0:339b7abfa147 310 return true;
Osator 0:339b7abfa147 311 }
Osator 0:339b7abfa147 312
Osator 0:339b7abfa147 313
Osator 0:339b7abfa147 314 bool USBMSD::readCapacity (void) {
Osator 0:339b7abfa147 315 uint8_t capacity[] = {
Osator 0:339b7abfa147 316 (uint8_t)(((BlockCount - 1) >> 24) & 0xff),
Osator 0:339b7abfa147 317 (uint8_t)(((BlockCount - 1) >> 16) & 0xff),
Osator 0:339b7abfa147 318 (uint8_t)(((BlockCount - 1) >> 8) & 0xff),
Osator 0:339b7abfa147 319 (uint8_t)(((BlockCount - 1) >> 0) & 0xff),
Osator 0:339b7abfa147 320
Osator 0:339b7abfa147 321 (uint8_t)((BlockSize >> 24) & 0xff),
Osator 0:339b7abfa147 322 (uint8_t)((BlockSize >> 16) & 0xff),
Osator 0:339b7abfa147 323 (uint8_t)((BlockSize >> 8) & 0xff),
Osator 0:339b7abfa147 324 (uint8_t)((BlockSize >> 0) & 0xff),
Osator 0:339b7abfa147 325 };
Osator 0:339b7abfa147 326 if (!write(capacity, sizeof(capacity))) {
Osator 0:339b7abfa147 327 return false;
Osator 0:339b7abfa147 328 }
Osator 0:339b7abfa147 329 return true;
Osator 0:339b7abfa147 330 }
Osator 0:339b7abfa147 331
Osator 0:339b7abfa147 332 bool USBMSD::write (uint8_t * buf, uint16_t size) {
Osator 0:339b7abfa147 333
Osator 0:339b7abfa147 334 if (size >= cbw.DataLength) {
Osator 0:339b7abfa147 335 size = cbw.DataLength;
Osator 0:339b7abfa147 336 }
Osator 0:339b7abfa147 337 stage = SEND_CSW;
Osator 0:339b7abfa147 338
Osator 0:339b7abfa147 339 if (!writeNB(EPBULK_IN, buf, size, MAX_PACKET_SIZE_EPBULK)) {
Osator 0:339b7abfa147 340 return false;
Osator 0:339b7abfa147 341 }
Osator 0:339b7abfa147 342
Osator 0:339b7abfa147 343 csw.DataResidue -= size;
Osator 0:339b7abfa147 344 csw.Status = CSW_PASSED;
Osator 0:339b7abfa147 345 return true;
Osator 0:339b7abfa147 346 }
Osator 0:339b7abfa147 347
Osator 0:339b7abfa147 348
Osator 0:339b7abfa147 349 bool USBMSD::modeSense6 (void) {
Osator 0:339b7abfa147 350 uint8_t sense6[] = { 0x03, 0x00, 0x00, 0x00 };
Osator 0:339b7abfa147 351 if (!write(sense6, sizeof(sense6))) {
Osator 0:339b7abfa147 352 return false;
Osator 0:339b7abfa147 353 }
Osator 0:339b7abfa147 354 return true;
Osator 0:339b7abfa147 355 }
Osator 0:339b7abfa147 356
Osator 0:339b7abfa147 357 void USBMSD::sendCSW() {
Osator 0:339b7abfa147 358 csw.Signature = CSW_Signature;
Osator 0:339b7abfa147 359 writeNB(EPBULK_IN, (uint8_t *)&csw, sizeof(CSW), MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 360 stage = WAIT_CSW;
Osator 0:339b7abfa147 361 }
Osator 0:339b7abfa147 362
Osator 0:339b7abfa147 363 bool USBMSD::requestSense (void) {
Osator 0:339b7abfa147 364 uint8_t request_sense[] = {
Osator 0:339b7abfa147 365 0x70,
Osator 0:339b7abfa147 366 0x00,
Osator 0:339b7abfa147 367 0x05, // Sense Key: illegal request
Osator 0:339b7abfa147 368 0x00,
Osator 0:339b7abfa147 369 0x00,
Osator 0:339b7abfa147 370 0x00,
Osator 0:339b7abfa147 371 0x00,
Osator 0:339b7abfa147 372 0x0A,
Osator 0:339b7abfa147 373 0x00,
Osator 0:339b7abfa147 374 0x00,
Osator 0:339b7abfa147 375 0x00,
Osator 0:339b7abfa147 376 0x00,
Osator 0:339b7abfa147 377 0x30,
Osator 0:339b7abfa147 378 0x01,
Osator 0:339b7abfa147 379 0x00,
Osator 0:339b7abfa147 380 0x00,
Osator 0:339b7abfa147 381 0x00,
Osator 0:339b7abfa147 382 0x00,
Osator 0:339b7abfa147 383 };
Osator 0:339b7abfa147 384
Osator 0:339b7abfa147 385 if (!write(request_sense, sizeof(request_sense))) {
Osator 0:339b7abfa147 386 return false;
Osator 0:339b7abfa147 387 }
Osator 0:339b7abfa147 388
Osator 0:339b7abfa147 389 return true;
Osator 0:339b7abfa147 390 }
Osator 0:339b7abfa147 391
Osator 0:339b7abfa147 392 void USBMSD::fail() {
Osator 0:339b7abfa147 393 csw.Status = CSW_FAILED;
Osator 0:339b7abfa147 394 sendCSW();
Osator 0:339b7abfa147 395 }
Osator 0:339b7abfa147 396
Osator 0:339b7abfa147 397
Osator 0:339b7abfa147 398 void USBMSD::CBWDecode(uint8_t * buf, uint16_t size) {
Osator 0:339b7abfa147 399 if (size == sizeof(cbw)) {
Osator 0:339b7abfa147 400 memcpy((uint8_t *)&cbw, buf, size);
Osator 0:339b7abfa147 401 if (cbw.Signature == CBW_Signature) {
Osator 0:339b7abfa147 402 csw.Tag = cbw.Tag;
Osator 0:339b7abfa147 403 csw.DataResidue = cbw.DataLength;
Osator 0:339b7abfa147 404 if ((cbw.CBLength < 1) || (cbw.CBLength > 16) ) {
Osator 0:339b7abfa147 405 fail();
Osator 0:339b7abfa147 406 } else {
Osator 0:339b7abfa147 407 switch (cbw.CB[0]) {
Osator 0:339b7abfa147 408 case TEST_UNIT_READY:
Osator 0:339b7abfa147 409 testUnitReady();
Osator 0:339b7abfa147 410 break;
Osator 0:339b7abfa147 411 case REQUEST_SENSE:
Osator 0:339b7abfa147 412 requestSense();
Osator 0:339b7abfa147 413 break;
Osator 0:339b7abfa147 414 case INQUIRY:
Osator 0:339b7abfa147 415 inquiryRequest();
Osator 0:339b7abfa147 416 break;
Osator 0:339b7abfa147 417 case MODE_SENSE6:
Osator 0:339b7abfa147 418 modeSense6();
Osator 0:339b7abfa147 419 break;
Osator 0:339b7abfa147 420 case READ_FORMAT_CAPACITIES:
Osator 0:339b7abfa147 421 readFormatCapacity();
Osator 0:339b7abfa147 422 break;
Osator 0:339b7abfa147 423 case READ_CAPACITY:
Osator 0:339b7abfa147 424 readCapacity();
Osator 0:339b7abfa147 425 break;
Osator 0:339b7abfa147 426 case READ10:
Osator 0:339b7abfa147 427 case READ12:
Osator 0:339b7abfa147 428 if (infoTransfer()) {
Osator 0:339b7abfa147 429 if ((cbw.Flags & 0x80)) {
Osator 0:339b7abfa147 430 stage = PROCESS_CBW;
Osator 0:339b7abfa147 431 memoryRead();
Osator 0:339b7abfa147 432 } else {
Osator 0:339b7abfa147 433 stallEndpoint(EPBULK_OUT);
Osator 0:339b7abfa147 434 csw.Status = CSW_ERROR;
Osator 0:339b7abfa147 435 sendCSW();
Osator 0:339b7abfa147 436 }
Osator 0:339b7abfa147 437 }
Osator 0:339b7abfa147 438 break;
Osator 0:339b7abfa147 439 case WRITE10:
Osator 0:339b7abfa147 440 case WRITE12:
Osator 0:339b7abfa147 441 if (infoTransfer()) {
Osator 0:339b7abfa147 442 if (!(cbw.Flags & 0x80)) {
Osator 0:339b7abfa147 443 stage = PROCESS_CBW;
Osator 0:339b7abfa147 444 } else {
Osator 0:339b7abfa147 445 stallEndpoint(EPBULK_IN);
Osator 0:339b7abfa147 446 csw.Status = CSW_ERROR;
Osator 0:339b7abfa147 447 sendCSW();
Osator 0:339b7abfa147 448 }
Osator 0:339b7abfa147 449 }
Osator 0:339b7abfa147 450 break;
Osator 0:339b7abfa147 451 case VERIFY10:
Osator 0:339b7abfa147 452 if (!(cbw.CB[1] & 0x02)) {
Osator 0:339b7abfa147 453 csw.Status = CSW_PASSED;
Osator 0:339b7abfa147 454 sendCSW();
Osator 0:339b7abfa147 455 break;
Osator 0:339b7abfa147 456 }
Osator 0:339b7abfa147 457 if (infoTransfer()) {
Osator 0:339b7abfa147 458 if (!(cbw.Flags & 0x80)) {
Osator 0:339b7abfa147 459 stage = PROCESS_CBW;
Osator 0:339b7abfa147 460 memOK = true;
Osator 0:339b7abfa147 461 } else {
Osator 0:339b7abfa147 462 stallEndpoint(EPBULK_IN);
Osator 0:339b7abfa147 463 csw.Status = CSW_ERROR;
Osator 0:339b7abfa147 464 sendCSW();
Osator 0:339b7abfa147 465 }
Osator 0:339b7abfa147 466 }
Osator 0:339b7abfa147 467 break;
Osator 0:339b7abfa147 468 case MEDIA_REMOVAL:
Osator 0:339b7abfa147 469 csw.Status = CSW_PASSED;
Osator 0:339b7abfa147 470 sendCSW();
Osator 0:339b7abfa147 471 break;
Osator 0:339b7abfa147 472 default:
Osator 0:339b7abfa147 473 fail();
Osator 0:339b7abfa147 474 break;
Osator 0:339b7abfa147 475 }
Osator 0:339b7abfa147 476 }
Osator 0:339b7abfa147 477 }
Osator 0:339b7abfa147 478 }
Osator 0:339b7abfa147 479 }
Osator 0:339b7abfa147 480
Osator 0:339b7abfa147 481 void USBMSD::testUnitReady (void) {
Osator 0:339b7abfa147 482
Osator 0:339b7abfa147 483 if (cbw.DataLength != 0) {
Osator 0:339b7abfa147 484 if ((cbw.Flags & 0x80) != 0) {
Osator 0:339b7abfa147 485 stallEndpoint(EPBULK_IN);
Osator 0:339b7abfa147 486 } else {
Osator 0:339b7abfa147 487 stallEndpoint(EPBULK_OUT);
Osator 0:339b7abfa147 488 }
Osator 0:339b7abfa147 489 }
Osator 0:339b7abfa147 490
Osator 0:339b7abfa147 491 csw.Status = CSW_PASSED;
Osator 0:339b7abfa147 492 sendCSW();
Osator 0:339b7abfa147 493 }
Osator 0:339b7abfa147 494
Osator 0:339b7abfa147 495
Osator 0:339b7abfa147 496 void USBMSD::memoryRead (void) {
Osator 0:339b7abfa147 497 uint32_t n;
Osator 0:339b7abfa147 498
Osator 0:339b7abfa147 499 n = (length > MAX_PACKET) ? MAX_PACKET : length;
Osator 0:339b7abfa147 500
Osator 0:339b7abfa147 501 if ((addr + n) > MemorySize) {
Osator 0:339b7abfa147 502 n = MemorySize - addr;
Osator 0:339b7abfa147 503 stage = ERROR;
Osator 0:339b7abfa147 504 }
Osator 0:339b7abfa147 505
Osator 0:339b7abfa147 506 // we read an entire block
Osator 0:339b7abfa147 507 if (!(addr%BlockSize))
Osator 0:339b7abfa147 508 disk_read(page, addr/BlockSize);
Osator 0:339b7abfa147 509
Osator 0:339b7abfa147 510 // write data which are in RAM
Osator 0:339b7abfa147 511 writeNB(EPBULK_IN, &page[addr%BlockSize], n, MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 512
Osator 0:339b7abfa147 513 addr += n;
Osator 0:339b7abfa147 514 length -= n;
Osator 0:339b7abfa147 515
Osator 0:339b7abfa147 516 csw.DataResidue -= n;
Osator 0:339b7abfa147 517
Osator 0:339b7abfa147 518 if ( !length || (stage != PROCESS_CBW)) {
Osator 0:339b7abfa147 519 csw.Status = (stage == PROCESS_CBW) ? CSW_PASSED : CSW_FAILED;
Osator 0:339b7abfa147 520 stage = (stage == PROCESS_CBW) ? SEND_CSW : stage;
Osator 0:339b7abfa147 521 }
Osator 0:339b7abfa147 522 }
Osator 0:339b7abfa147 523
Osator 0:339b7abfa147 524
Osator 0:339b7abfa147 525 bool USBMSD::infoTransfer (void) {
Osator 0:339b7abfa147 526 uint32_t n;
Osator 0:339b7abfa147 527
Osator 0:339b7abfa147 528 // Logical Block Address of First Block
Osator 0:339b7abfa147 529 n = (cbw.CB[2] << 24) | (cbw.CB[3] << 16) | (cbw.CB[4] << 8) | (cbw.CB[5] << 0);
Osator 0:339b7abfa147 530
Osator 0:339b7abfa147 531 addr = n * BlockSize;
Osator 0:339b7abfa147 532
Osator 0:339b7abfa147 533 // Number of Blocks to transfer
Osator 0:339b7abfa147 534 switch (cbw.CB[0]) {
Osator 0:339b7abfa147 535 case READ10:
Osator 0:339b7abfa147 536 case WRITE10:
Osator 0:339b7abfa147 537 case VERIFY10:
Osator 0:339b7abfa147 538 n = (cbw.CB[7] << 8) | (cbw.CB[8] << 0);
Osator 0:339b7abfa147 539 break;
Osator 0:339b7abfa147 540
Osator 0:339b7abfa147 541 case READ12:
Osator 0:339b7abfa147 542 case WRITE12:
Osator 0:339b7abfa147 543 n = (cbw.CB[6] << 24) | (cbw.CB[7] << 16) | (cbw.CB[8] << 8) | (cbw.CB[9] << 0);
Osator 0:339b7abfa147 544 break;
Osator 0:339b7abfa147 545 }
Osator 0:339b7abfa147 546
Osator 0:339b7abfa147 547 length = n * BlockSize;
Osator 0:339b7abfa147 548
Osator 0:339b7abfa147 549 if (!cbw.DataLength) { // host requests no data
Osator 0:339b7abfa147 550 csw.Status = CSW_FAILED;
Osator 0:339b7abfa147 551 sendCSW();
Osator 0:339b7abfa147 552 return false;
Osator 0:339b7abfa147 553 }
Osator 0:339b7abfa147 554
Osator 0:339b7abfa147 555 if (cbw.DataLength != length) {
Osator 0:339b7abfa147 556 if ((cbw.Flags & 0x80) != 0) {
Osator 0:339b7abfa147 557 stallEndpoint(EPBULK_IN);
Osator 0:339b7abfa147 558 } else {
Osator 0:339b7abfa147 559 stallEndpoint(EPBULK_OUT);
Osator 0:339b7abfa147 560 }
Osator 0:339b7abfa147 561
Osator 0:339b7abfa147 562 csw.Status = CSW_FAILED;
Osator 0:339b7abfa147 563 sendCSW();
Osator 0:339b7abfa147 564 return false;
Osator 0:339b7abfa147 565 }
Osator 0:339b7abfa147 566
Osator 0:339b7abfa147 567 return true;
Osator 0:339b7abfa147 568 }
Osator 0:339b7abfa147 569
Osator 0:339b7abfa147 570
Osator 0:339b7abfa147 571
Osator 0:339b7abfa147 572
Osator 0:339b7abfa147 573
Osator 0:339b7abfa147 574 // Called in ISR context
Osator 0:339b7abfa147 575 // Set configuration. Return false if the
Osator 0:339b7abfa147 576 // configuration is not supported.
Osator 0:339b7abfa147 577 bool USBMSD::USBCallback_setConfiguration(uint8_t configuration) {
Osator 0:339b7abfa147 578 if (configuration != DEFAULT_CONFIGURATION) {
Osator 0:339b7abfa147 579 return false;
Osator 0:339b7abfa147 580 }
Osator 0:339b7abfa147 581
Osator 0:339b7abfa147 582 // Configure endpoints > 0
Osator 0:339b7abfa147 583 addEndpoint(EPBULK_IN, MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 584 addEndpoint(EPBULK_OUT, MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 585
Osator 0:339b7abfa147 586 //activate readings
Osator 0:339b7abfa147 587 readStart(EPBULK_OUT, MAX_PACKET_SIZE_EPBULK);
Osator 0:339b7abfa147 588 return true;
Osator 0:339b7abfa147 589 }
Osator 0:339b7abfa147 590
Osator 0:339b7abfa147 591
Osator 0:339b7abfa147 592 uint8_t * USBMSD::stringIinterfaceDesc() {
Osator 0:339b7abfa147 593 static uint8_t stringIinterfaceDescriptor[] = {
Osator 0:339b7abfa147 594 0x08, //bLength
Osator 0:339b7abfa147 595 STRING_DESCRIPTOR, //bDescriptorType 0x03
Osator 0:339b7abfa147 596 'M',0,'S',0,'D',0 //bString iInterface - MSD
Osator 0:339b7abfa147 597 };
Osator 0:339b7abfa147 598 return stringIinterfaceDescriptor;
Osator 0:339b7abfa147 599 }
Osator 0:339b7abfa147 600
Osator 0:339b7abfa147 601 uint8_t * USBMSD::stringIproductDesc() {
Osator 0:339b7abfa147 602 static uint8_t stringIproductDescriptor[] = {
Osator 0:339b7abfa147 603 0x12, //bLength
Osator 0:339b7abfa147 604 STRING_DESCRIPTOR, //bDescriptorType 0x03
Osator 0:339b7abfa147 605 'M',0,'b',0,'e',0,'d',0,' ',0,'M',0,'S',0,'D',0 //bString iProduct - Mbed Audio
Osator 0:339b7abfa147 606 };
Osator 0:339b7abfa147 607 return stringIproductDescriptor;
Osator 0:339b7abfa147 608 }
Osator 0:339b7abfa147 609
Osator 0:339b7abfa147 610
Osator 0:339b7abfa147 611 uint8_t * USBMSD::configurationDesc() {
Osator 0:339b7abfa147 612 static uint8_t configDescriptor[] = {
Osator 0:339b7abfa147 613
Osator 0:339b7abfa147 614 // Configuration 1
Osator 0:339b7abfa147 615 9, // bLength
Osator 0:339b7abfa147 616 2, // bDescriptorType
Osator 0:339b7abfa147 617 LSB(9 + 9 + 7 + 7), // wTotalLength
Osator 0:339b7abfa147 618 MSB(9 + 9 + 7 + 7),
Osator 0:339b7abfa147 619 0x01, // bNumInterfaces
Osator 0:339b7abfa147 620 0x01, // bConfigurationValue: 0x01 is used to select this configuration
Osator 0:339b7abfa147 621 0x00, // iConfiguration: no string to describe this configuration
Osator 0:339b7abfa147 622 0xC0, // bmAttributes
Osator 0:339b7abfa147 623 100, // bMaxPower, device power consumption is 100 mA
Osator 0:339b7abfa147 624
Osator 0:339b7abfa147 625 // Interface 0, Alternate Setting 0, MSC Class
Osator 0:339b7abfa147 626 9, // bLength
Osator 0:339b7abfa147 627 4, // bDescriptorType
Osator 0:339b7abfa147 628 0x00, // bInterfaceNumber
Osator 0:339b7abfa147 629 0x00, // bAlternateSetting
Osator 0:339b7abfa147 630 0x02, // bNumEndpoints
Osator 0:339b7abfa147 631 0x08, // bInterfaceClass
Osator 0:339b7abfa147 632 0x06, // bInterfaceSubClass
Osator 0:339b7abfa147 633 0x50, // bInterfaceProtocol
Osator 0:339b7abfa147 634 0x04, // iInterface
Osator 0:339b7abfa147 635
Osator 0:339b7abfa147 636 // endpoint descriptor, USB spec 9.6.6, page 269-271, Table 9-13
Osator 0:339b7abfa147 637 7, // bLength
Osator 0:339b7abfa147 638 5, // bDescriptorType
Osator 0:339b7abfa147 639 PHY_TO_DESC(EPBULK_IN), // bEndpointAddress
Osator 0:339b7abfa147 640 0x02, // bmAttributes (0x02=bulk)
Osator 0:339b7abfa147 641 LSB(MAX_PACKET_SIZE_EPBULK),// wMaxPacketSize (LSB)
Osator 0:339b7abfa147 642 MSB(MAX_PACKET_SIZE_EPBULK),// wMaxPacketSize (MSB)
Osator 0:339b7abfa147 643 0, // bInterval
Osator 0:339b7abfa147 644
Osator 0:339b7abfa147 645 // endpoint descriptor, USB spec 9.6.6, page 269-271, Table 9-13
Osator 0:339b7abfa147 646 7, // bLength
Osator 0:339b7abfa147 647 5, // bDescriptorType
Osator 0:339b7abfa147 648 PHY_TO_DESC(EPBULK_OUT), // bEndpointAddress
Osator 0:339b7abfa147 649 0x02, // bmAttributes (0x02=bulk)
Osator 0:339b7abfa147 650 LSB(MAX_PACKET_SIZE_EPBULK),// wMaxPacketSize (LSB)
Osator 0:339b7abfa147 651 MSB(MAX_PACKET_SIZE_EPBULK),// wMaxPacketSize (MSB)
Osator 0:339b7abfa147 652 0 // bInterval
Osator 0:339b7abfa147 653 };
Osator 0:339b7abfa147 654 return configDescriptor;
Osator 0:339b7abfa147 655 }