ON Semiconductor / mbed-os

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   mbed-TFT-example-NCS36510 mbed-Accelerometer-example-NCS36510 mbed-Accelerometer-example-NCS36510

features/unsupported/USBDevice/USBMSD/USBMSD.cpp@1:f30bdcd2b33b, 2017-02-27 (annotated)

Committer:
jacobjohnson
Date:
Mon Feb 27 17:45:05 2017 +0000
Revision:
1:f30bdcd2b33b
Parent:
0:098463de4c5d 
changed the inputscale from 1 to 7 in analogin_api.c.  This will need to be changed later, and accessed from the main level, but for now this allows the  adc to read a value from 0 to 3.7V, instead of just up to 1V.;

Who changed what in which revision?

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