BA / SerialCom

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.

Fork of OmniWheels by Gustav Atmel

mbed-os/features/unsupported/USBHost/USBHostMSD/USBHostMSD.cpp@1:9c5af431a1f1, 2018-05-01 (annotated)

Committer:
gustavatmel
Date:
Tue May 01 15:47:08 2018 +0000
Revision:
1:9c5af431a1f1
sdf

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gustavatmel 1:9c5af431a1f1 1 /* mbed USBHost Library
gustavatmel 1:9c5af431a1f1 2 * Copyright (c) 2006-2013 ARM Limited
gustavatmel 1:9c5af431a1f1 3 *
gustavatmel 1:9c5af431a1f1 4 * Licensed under the Apache License, Version 2.0 (the "License");
gustavatmel 1:9c5af431a1f1 5 * you may not use this file except in compliance with the License.
gustavatmel 1:9c5af431a1f1 6 * You may obtain a copy of the License at
gustavatmel 1:9c5af431a1f1 7 *
gustavatmel 1:9c5af431a1f1 8 * http://www.apache.org/licenses/LICENSE-2.0
gustavatmel 1:9c5af431a1f1 9 *
gustavatmel 1:9c5af431a1f1 10 * Unless required by applicable law or agreed to in writing, software
gustavatmel 1:9c5af431a1f1 11 * distributed under the License is distributed on an "AS IS" BASIS,
gustavatmel 1:9c5af431a1f1 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
gustavatmel 1:9c5af431a1f1 13 * See the License for the specific language governing permissions and
gustavatmel 1:9c5af431a1f1 14 * limitations under the License.
gustavatmel 1:9c5af431a1f1 15 */
gustavatmel 1:9c5af431a1f1 16
gustavatmel 1:9c5af431a1f1 17 #include "USBHostMSD.h"
gustavatmel 1:9c5af431a1f1 18
gustavatmel 1:9c5af431a1f1 19 #if USBHOST_MSD
gustavatmel 1:9c5af431a1f1 20 #include "dbg.h"
gustavatmel 1:9c5af431a1f1 21
gustavatmel 1:9c5af431a1f1 22 #define CBW_SIGNATURE 0x43425355
gustavatmel 1:9c5af431a1f1 23 #define CSW_SIGNATURE 0x53425355
gustavatmel 1:9c5af431a1f1 24
gustavatmel 1:9c5af431a1f1 25 #define DEVICE_TO_HOST 0x80
gustavatmel 1:9c5af431a1f1 26 #define HOST_TO_DEVICE 0x00
gustavatmel 1:9c5af431a1f1 27
gustavatmel 1:9c5af431a1f1 28 #define GET_MAX_LUN (0xFE)
gustavatmel 1:9c5af431a1f1 29 #define BO_MASS_STORAGE_RESET (0xFF)
gustavatmel 1:9c5af431a1f1 30
gustavatmel 1:9c5af431a1f1 31 USBHostMSD::USBHostMSD()
gustavatmel 1:9c5af431a1f1 32 {
gustavatmel 1:9c5af431a1f1 33 host = USBHost::getHostInst();
gustavatmel 1:9c5af431a1f1 34 /* register an object in FAT */
gustavatmel 1:9c5af431a1f1 35
gustavatmel 1:9c5af431a1f1 36 init_usb();
gustavatmel 1:9c5af431a1f1 37 }
gustavatmel 1:9c5af431a1f1 38
gustavatmel 1:9c5af431a1f1 39 void USBHostMSD::init_usb()
gustavatmel 1:9c5af431a1f1 40 {
gustavatmel 1:9c5af431a1f1 41 dev_connected = false;
gustavatmel 1:9c5af431a1f1 42 dev = NULL;
gustavatmel 1:9c5af431a1f1 43 bulk_in = NULL;
gustavatmel 1:9c5af431a1f1 44 bulk_out = NULL;
gustavatmel 1:9c5af431a1f1 45 dev_connected = false;
gustavatmel 1:9c5af431a1f1 46 blockSize = 0;
gustavatmel 1:9c5af431a1f1 47 blockCount = 0;
gustavatmel 1:9c5af431a1f1 48 msd_intf = -1;
gustavatmel 1:9c5af431a1f1 49 msd_device_found = false;
gustavatmel 1:9c5af431a1f1 50 disk_init = false;
gustavatmel 1:9c5af431a1f1 51 dev_connected = false;
gustavatmel 1:9c5af431a1f1 52 nb_ep = 0;
gustavatmel 1:9c5af431a1f1 53 }
gustavatmel 1:9c5af431a1f1 54
gustavatmel 1:9c5af431a1f1 55
gustavatmel 1:9c5af431a1f1 56 bool USBHostMSD::connected()
gustavatmel 1:9c5af431a1f1 57 {
gustavatmel 1:9c5af431a1f1 58 return dev_connected;
gustavatmel 1:9c5af431a1f1 59 }
gustavatmel 1:9c5af431a1f1 60
gustavatmel 1:9c5af431a1f1 61 bool USBHostMSD::connect()
gustavatmel 1:9c5af431a1f1 62 {
gustavatmel 1:9c5af431a1f1 63
gustavatmel 1:9c5af431a1f1 64 if (dev_connected) {
gustavatmel 1:9c5af431a1f1 65 return true;
gustavatmel 1:9c5af431a1f1 66 }
gustavatmel 1:9c5af431a1f1 67
gustavatmel 1:9c5af431a1f1 68 for (uint8_t i = 0; i < MAX_DEVICE_CONNECTED; i++) {
gustavatmel 1:9c5af431a1f1 69 if ((dev = host->getDevice(i)) != NULL) {
gustavatmel 1:9c5af431a1f1 70
gustavatmel 1:9c5af431a1f1 71 USB_DBG("Trying to connect MSD device\r\n");
gustavatmel 1:9c5af431a1f1 72
gustavatmel 1:9c5af431a1f1 73 if(host->enumerate(dev, this))
gustavatmel 1:9c5af431a1f1 74 break;
gustavatmel 1:9c5af431a1f1 75
gustavatmel 1:9c5af431a1f1 76 if (msd_device_found) {
gustavatmel 1:9c5af431a1f1 77 /* As this is done in a specific thread
gustavatmel 1:9c5af431a1f1 78 * this lock is taken to avoid to process a disconnection in
gustavatmel 1:9c5af431a1f1 79 * usb process during the device registering */
gustavatmel 1:9c5af431a1f1 80 USBHost::Lock Lock(host);
gustavatmel 1:9c5af431a1f1 81
gustavatmel 1:9c5af431a1f1 82 bulk_in = dev->getEndpoint(msd_intf, BULK_ENDPOINT, IN);
gustavatmel 1:9c5af431a1f1 83 bulk_out = dev->getEndpoint(msd_intf, BULK_ENDPOINT, OUT);
gustavatmel 1:9c5af431a1f1 84
gustavatmel 1:9c5af431a1f1 85 if (!bulk_in || !bulk_out)
gustavatmel 1:9c5af431a1f1 86 continue;
gustavatmel 1:9c5af431a1f1 87
gustavatmel 1:9c5af431a1f1 88 USB_INFO("New MSD device: VID:%04x PID:%04x [dev: %p - intf: %d]", dev->getVid(), dev->getPid(), dev, msd_intf);
gustavatmel 1:9c5af431a1f1 89 dev->setName("MSD", msd_intf);
gustavatmel 1:9c5af431a1f1 90 host->registerDriver(dev, msd_intf, this, &USBHostMSD::init_usb);
gustavatmel 1:9c5af431a1f1 91
gustavatmel 1:9c5af431a1f1 92 dev_connected = true;
gustavatmel 1:9c5af431a1f1 93 return true;
gustavatmel 1:9c5af431a1f1 94 }
gustavatmel 1:9c5af431a1f1 95 } //if()
gustavatmel 1:9c5af431a1f1 96 } //for()
gustavatmel 1:9c5af431a1f1 97 init_usb();
gustavatmel 1:9c5af431a1f1 98 return false;
gustavatmel 1:9c5af431a1f1 99 }
gustavatmel 1:9c5af431a1f1 100
gustavatmel 1:9c5af431a1f1 101 /*virtual*/ void USBHostMSD::setVidPid(uint16_t vid, uint16_t pid)
gustavatmel 1:9c5af431a1f1 102 {
gustavatmel 1:9c5af431a1f1 103 // we don't check VID/PID for MSD driver
gustavatmel 1:9c5af431a1f1 104 }
gustavatmel 1:9c5af431a1f1 105
gustavatmel 1:9c5af431a1f1 106 /*virtual*/ bool USBHostMSD::parseInterface(uint8_t intf_nb, uint8_t intf_class, uint8_t intf_subclass, uint8_t intf_protocol) //Must return true if the interface should be parsed
gustavatmel 1:9c5af431a1f1 107 {
gustavatmel 1:9c5af431a1f1 108 if ((msd_intf == -1) &&
gustavatmel 1:9c5af431a1f1 109 (intf_class == MSD_CLASS) &&
gustavatmel 1:9c5af431a1f1 110 (intf_subclass == 0x06) &&
gustavatmel 1:9c5af431a1f1 111 (intf_protocol == 0x50)) {
gustavatmel 1:9c5af431a1f1 112 msd_intf = intf_nb;
gustavatmel 1:9c5af431a1f1 113 return true;
gustavatmel 1:9c5af431a1f1 114 }
gustavatmel 1:9c5af431a1f1 115 return false;
gustavatmel 1:9c5af431a1f1 116 }
gustavatmel 1:9c5af431a1f1 117
gustavatmel 1:9c5af431a1f1 118 /*virtual*/ bool USBHostMSD::useEndpoint(uint8_t intf_nb, ENDPOINT_TYPE type, ENDPOINT_DIRECTION dir) //Must return true if the endpoint will be used
gustavatmel 1:9c5af431a1f1 119 {
gustavatmel 1:9c5af431a1f1 120 if (intf_nb == msd_intf) {
gustavatmel 1:9c5af431a1f1 121 if (type == BULK_ENDPOINT) {
gustavatmel 1:9c5af431a1f1 122 nb_ep++;
gustavatmel 1:9c5af431a1f1 123 if (nb_ep == 2)
gustavatmel 1:9c5af431a1f1 124 msd_device_found = true;
gustavatmel 1:9c5af431a1f1 125 return true;
gustavatmel 1:9c5af431a1f1 126 }
gustavatmel 1:9c5af431a1f1 127 }
gustavatmel 1:9c5af431a1f1 128 return false;
gustavatmel 1:9c5af431a1f1 129 }
gustavatmel 1:9c5af431a1f1 130
gustavatmel 1:9c5af431a1f1 131
gustavatmel 1:9c5af431a1f1 132 int USBHostMSD::testUnitReady()
gustavatmel 1:9c5af431a1f1 133 {
gustavatmel 1:9c5af431a1f1 134 USB_DBG("Test unit ready");
gustavatmel 1:9c5af431a1f1 135 return SCSITransfer(NULL, 6, DEVICE_TO_HOST, 0, 0);
gustavatmel 1:9c5af431a1f1 136 }
gustavatmel 1:9c5af431a1f1 137
gustavatmel 1:9c5af431a1f1 138
gustavatmel 1:9c5af431a1f1 139 int USBHostMSD::readCapacity()
gustavatmel 1:9c5af431a1f1 140 {
gustavatmel 1:9c5af431a1f1 141 USB_DBG("Read capacity");
gustavatmel 1:9c5af431a1f1 142 uint8_t cmd[10] = {0x25,0,0,0,0,0,0,0,0,0};
gustavatmel 1:9c5af431a1f1 143 uint8_t result[8];
gustavatmel 1:9c5af431a1f1 144 int status = SCSITransfer(cmd, 10, DEVICE_TO_HOST, result, 8);
gustavatmel 1:9c5af431a1f1 145 if (status == 0) {
gustavatmel 1:9c5af431a1f1 146 blockCount = (result[0] << 24) | (result[1] << 16) | (result[2] << 8) | result[3];
gustavatmel 1:9c5af431a1f1 147 blockSize = (result[4] << 24) | (result[5] << 16) | (result[6] << 8) | result[7];
gustavatmel 1:9c5af431a1f1 148 USB_INFO("MSD [dev: %p] - blockCount: %u, blockSize: %d, Capacity: %d\r\n", dev, blockCount, blockSize, blockCount*blockSize);
gustavatmel 1:9c5af431a1f1 149 }
gustavatmel 1:9c5af431a1f1 150 return status;
gustavatmel 1:9c5af431a1f1 151 }
gustavatmel 1:9c5af431a1f1 152
gustavatmel 1:9c5af431a1f1 153
gustavatmel 1:9c5af431a1f1 154 int USBHostMSD::SCSIRequestSense()
gustavatmel 1:9c5af431a1f1 155 {
gustavatmel 1:9c5af431a1f1 156 USB_DBG("Request sense");
gustavatmel 1:9c5af431a1f1 157 uint8_t cmd[6] = {0x03,0,0,0,18,0};
gustavatmel 1:9c5af431a1f1 158 uint8_t result[18];
gustavatmel 1:9c5af431a1f1 159 int status = SCSITransfer(cmd, 6, DEVICE_TO_HOST, result, 18);
gustavatmel 1:9c5af431a1f1 160 return status;
gustavatmel 1:9c5af431a1f1 161 }
gustavatmel 1:9c5af431a1f1 162
gustavatmel 1:9c5af431a1f1 163
gustavatmel 1:9c5af431a1f1 164 int USBHostMSD::inquiry(uint8_t lun, uint8_t page_code)
gustavatmel 1:9c5af431a1f1 165 {
gustavatmel 1:9c5af431a1f1 166 USB_DBG("Inquiry");
gustavatmel 1:9c5af431a1f1 167 uint8_t evpd = (page_code == 0) ? 0 : 1;
gustavatmel 1:9c5af431a1f1 168 uint8_t cmd[6] = {0x12, uint8_t((lun << 5) | evpd), page_code, 0, 36, 0};
gustavatmel 1:9c5af431a1f1 169 uint8_t result[36];
gustavatmel 1:9c5af431a1f1 170 int status = SCSITransfer(cmd, 6, DEVICE_TO_HOST, result, 36);
gustavatmel 1:9c5af431a1f1 171 if (status == 0) {
gustavatmel 1:9c5af431a1f1 172 char vid_pid[17];
gustavatmel 1:9c5af431a1f1 173 memcpy(vid_pid, &result[8], 8);
gustavatmel 1:9c5af431a1f1 174 vid_pid[8] = 0;
gustavatmel 1:9c5af431a1f1 175 USB_INFO("MSD [dev: %p] - Vendor ID: %s", dev, vid_pid);
gustavatmel 1:9c5af431a1f1 176
gustavatmel 1:9c5af431a1f1 177 memcpy(vid_pid, &result[16], 16);
gustavatmel 1:9c5af431a1f1 178 vid_pid[16] = 0;
gustavatmel 1:9c5af431a1f1 179 USB_INFO("MSD [dev: %p] - Product ID: %s", dev, vid_pid);
gustavatmel 1:9c5af431a1f1 180
gustavatmel 1:9c5af431a1f1 181 memcpy(vid_pid, &result[32], 4);
gustavatmel 1:9c5af431a1f1 182 vid_pid[4] = 0;
gustavatmel 1:9c5af431a1f1 183 USB_INFO("MSD [dev: %p] - Product rev: %s", dev, vid_pid);
gustavatmel 1:9c5af431a1f1 184 }
gustavatmel 1:9c5af431a1f1 185 return status;
gustavatmel 1:9c5af431a1f1 186 }
gustavatmel 1:9c5af431a1f1 187
gustavatmel 1:9c5af431a1f1 188 int USBHostMSD::checkResult(uint8_t res, USBEndpoint * ep)
gustavatmel 1:9c5af431a1f1 189 {
gustavatmel 1:9c5af431a1f1 190 // if ep stalled: send clear feature
gustavatmel 1:9c5af431a1f1 191 if (res == USB_TYPE_STALL_ERROR) {
gustavatmel 1:9c5af431a1f1 192 res = host->controlWrite( dev,
gustavatmel 1:9c5af431a1f1 193 USB_RECIPIENT_ENDPOINT | USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_STANDARD,
gustavatmel 1:9c5af431a1f1 194 CLEAR_FEATURE,
gustavatmel 1:9c5af431a1f1 195 0, ep->getAddress(), NULL, 0);
gustavatmel 1:9c5af431a1f1 196 // set state to IDLE if clear feature successful
gustavatmel 1:9c5af431a1f1 197 if (res == USB_TYPE_OK) {
gustavatmel 1:9c5af431a1f1 198 ep->setState(USB_TYPE_IDLE);
gustavatmel 1:9c5af431a1f1 199 }
gustavatmel 1:9c5af431a1f1 200 }
gustavatmel 1:9c5af431a1f1 201
gustavatmel 1:9c5af431a1f1 202 if (res != USB_TYPE_OK)
gustavatmel 1:9c5af431a1f1 203 return -1;
gustavatmel 1:9c5af431a1f1 204
gustavatmel 1:9c5af431a1f1 205 return 0;
gustavatmel 1:9c5af431a1f1 206 }
gustavatmel 1:9c5af431a1f1 207
gustavatmel 1:9c5af431a1f1 208
gustavatmel 1:9c5af431a1f1 209 int USBHostMSD::SCSITransfer(uint8_t * cmd, uint8_t cmd_len, int flags, uint8_t * data, uint32_t transfer_len)
gustavatmel 1:9c5af431a1f1 210 {
gustavatmel 1:9c5af431a1f1 211
gustavatmel 1:9c5af431a1f1 212 int res = 0;
gustavatmel 1:9c5af431a1f1 213
gustavatmel 1:9c5af431a1f1 214 cbw.Signature = CBW_SIGNATURE;
gustavatmel 1:9c5af431a1f1 215 cbw.Tag = 0;
gustavatmel 1:9c5af431a1f1 216 cbw.DataLength = transfer_len;
gustavatmel 1:9c5af431a1f1 217 cbw.Flags = flags;
gustavatmel 1:9c5af431a1f1 218 cbw.LUN = 0;
gustavatmel 1:9c5af431a1f1 219 cbw.CBLength = cmd_len;
gustavatmel 1:9c5af431a1f1 220 memset(cbw.CB,0,sizeof(cbw.CB));
gustavatmel 1:9c5af431a1f1 221 if (cmd) {
gustavatmel 1:9c5af431a1f1 222 memcpy(cbw.CB,cmd,cmd_len);
gustavatmel 1:9c5af431a1f1 223 }
gustavatmel 1:9c5af431a1f1 224
gustavatmel 1:9c5af431a1f1 225 // send the cbw
gustavatmel 1:9c5af431a1f1 226 USB_DBG("Send CBW");
gustavatmel 1:9c5af431a1f1 227 res = host->bulkWrite(dev, bulk_out,(uint8_t *)&cbw, 31);
gustavatmel 1:9c5af431a1f1 228 if (checkResult(res, bulk_out))
gustavatmel 1:9c5af431a1f1 229 return -1;
gustavatmel 1:9c5af431a1f1 230
gustavatmel 1:9c5af431a1f1 231 // data stage if needed
gustavatmel 1:9c5af431a1f1 232 if (data) {
gustavatmel 1:9c5af431a1f1 233 USB_DBG("data stage");
gustavatmel 1:9c5af431a1f1 234 if (flags == HOST_TO_DEVICE) {
gustavatmel 1:9c5af431a1f1 235
gustavatmel 1:9c5af431a1f1 236 res = host->bulkWrite(dev, bulk_out, data, transfer_len);
gustavatmel 1:9c5af431a1f1 237 if (checkResult(res, bulk_out))
gustavatmel 1:9c5af431a1f1 238 return -1;
gustavatmel 1:9c5af431a1f1 239
gustavatmel 1:9c5af431a1f1 240 } else if (flags == DEVICE_TO_HOST) {
gustavatmel 1:9c5af431a1f1 241
gustavatmel 1:9c5af431a1f1 242 res = host->bulkRead(dev, bulk_in, data, transfer_len);
gustavatmel 1:9c5af431a1f1 243 if (checkResult(res, bulk_in))
gustavatmel 1:9c5af431a1f1 244 return -1;
gustavatmel 1:9c5af431a1f1 245 }
gustavatmel 1:9c5af431a1f1 246 }
gustavatmel 1:9c5af431a1f1 247
gustavatmel 1:9c5af431a1f1 248 // status stage
gustavatmel 1:9c5af431a1f1 249 csw.Signature = 0;
gustavatmel 1:9c5af431a1f1 250 USB_DBG("Read CSW");
gustavatmel 1:9c5af431a1f1 251 res = host->bulkRead(dev, bulk_in,(uint8_t *)&csw, 13);
gustavatmel 1:9c5af431a1f1 252 if (checkResult(res, bulk_in))
gustavatmel 1:9c5af431a1f1 253 return -1;
gustavatmel 1:9c5af431a1f1 254
gustavatmel 1:9c5af431a1f1 255 if (csw.Signature != CSW_SIGNATURE) {
gustavatmel 1:9c5af431a1f1 256 return -1;
gustavatmel 1:9c5af431a1f1 257 }
gustavatmel 1:9c5af431a1f1 258
gustavatmel 1:9c5af431a1f1 259 USB_DBG("recv csw: status: %d", csw.Status);
gustavatmel 1:9c5af431a1f1 260
gustavatmel 1:9c5af431a1f1 261 // ModeSense?
gustavatmel 1:9c5af431a1f1 262 if ((csw.Status == 1) && (cmd[0] != 0x03)) {
gustavatmel 1:9c5af431a1f1 263 USB_DBG("request mode sense");
gustavatmel 1:9c5af431a1f1 264 return SCSIRequestSense();
gustavatmel 1:9c5af431a1f1 265 }
gustavatmel 1:9c5af431a1f1 266
gustavatmel 1:9c5af431a1f1 267 // perform reset recovery
gustavatmel 1:9c5af431a1f1 268 if ((csw.Status == 2) && (cmd[0] != 0x03)) {
gustavatmel 1:9c5af431a1f1 269
gustavatmel 1:9c5af431a1f1 270 // send Bulk-Only Mass Storage Reset request
gustavatmel 1:9c5af431a1f1 271 res = host->controlWrite( dev,
gustavatmel 1:9c5af431a1f1 272 USB_RECIPIENT_INTERFACE | USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_CLASS,
gustavatmel 1:9c5af431a1f1 273 BO_MASS_STORAGE_RESET,
gustavatmel 1:9c5af431a1f1 274 0, msd_intf, NULL, 0);
gustavatmel 1:9c5af431a1f1 275
gustavatmel 1:9c5af431a1f1 276 // unstall both endpoints
gustavatmel 1:9c5af431a1f1 277 res = host->controlWrite( dev,
gustavatmel 1:9c5af431a1f1 278 USB_RECIPIENT_ENDPOINT | USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_STANDARD,
gustavatmel 1:9c5af431a1f1 279 CLEAR_FEATURE,
gustavatmel 1:9c5af431a1f1 280 0, bulk_in->getAddress(), NULL, 0);
gustavatmel 1:9c5af431a1f1 281
gustavatmel 1:9c5af431a1f1 282 res = host->controlWrite( dev,
gustavatmel 1:9c5af431a1f1 283 USB_RECIPIENT_ENDPOINT | USB_HOST_TO_DEVICE | USB_REQUEST_TYPE_STANDARD,
gustavatmel 1:9c5af431a1f1 284 CLEAR_FEATURE,
gustavatmel 1:9c5af431a1f1 285 0, bulk_out->getAddress(), NULL, 0);
gustavatmel 1:9c5af431a1f1 286
gustavatmel 1:9c5af431a1f1 287 }
gustavatmel 1:9c5af431a1f1 288
gustavatmel 1:9c5af431a1f1 289 return csw.Status;
gustavatmel 1:9c5af431a1f1 290 }
gustavatmel 1:9c5af431a1f1 291
gustavatmel 1:9c5af431a1f1 292
gustavatmel 1:9c5af431a1f1 293 int USBHostMSD::dataTransfer(uint8_t * buf, uint32_t block, uint8_t nbBlock, int direction)
gustavatmel 1:9c5af431a1f1 294 {
gustavatmel 1:9c5af431a1f1 295 uint8_t cmd[10];
gustavatmel 1:9c5af431a1f1 296 memset(cmd,0,10);
gustavatmel 1:9c5af431a1f1 297 cmd[0] = (direction == DEVICE_TO_HOST) ? 0x28 : 0x2A;
gustavatmel 1:9c5af431a1f1 298
gustavatmel 1:9c5af431a1f1 299 cmd[2] = (block >> 24) & 0xff;
gustavatmel 1:9c5af431a1f1 300 cmd[3] = (block >> 16) & 0xff;
gustavatmel 1:9c5af431a1f1 301 cmd[4] = (block >> 8) & 0xff;
gustavatmel 1:9c5af431a1f1 302 cmd[5] = block & 0xff;
gustavatmel 1:9c5af431a1f1 303
gustavatmel 1:9c5af431a1f1 304 cmd[7] = (nbBlock >> 8) & 0xff;
gustavatmel 1:9c5af431a1f1 305 cmd[8] = nbBlock & 0xff;
gustavatmel 1:9c5af431a1f1 306
gustavatmel 1:9c5af431a1f1 307 return SCSITransfer(cmd, 10, direction, buf, blockSize*nbBlock);
gustavatmel 1:9c5af431a1f1 308 }
gustavatmel 1:9c5af431a1f1 309
gustavatmel 1:9c5af431a1f1 310 int USBHostMSD::getMaxLun()
gustavatmel 1:9c5af431a1f1 311 {
gustavatmel 1:9c5af431a1f1 312 uint8_t buf[1], res;
gustavatmel 1:9c5af431a1f1 313 res = host->controlRead( dev, USB_RECIPIENT_INTERFACE | USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS,
gustavatmel 1:9c5af431a1f1 314 0xfe, 0, msd_intf, buf, 1);
gustavatmel 1:9c5af431a1f1 315 USB_DBG("max lun: %d", buf[0]);
gustavatmel 1:9c5af431a1f1 316 return res;
gustavatmel 1:9c5af431a1f1 317 }
gustavatmel 1:9c5af431a1f1 318
gustavatmel 1:9c5af431a1f1 319 int USBHostMSD::init()
gustavatmel 1:9c5af431a1f1 320 {
gustavatmel 1:9c5af431a1f1 321 USB_DBG("FILESYSTEM: init");
gustavatmel 1:9c5af431a1f1 322 uint16_t i, timeout = 10, ret;
gustavatmel 1:9c5af431a1f1 323 getMaxLun();
gustavatmel 1:9c5af431a1f1 324 for (i = 0; i < timeout; i++) {
gustavatmel 1:9c5af431a1f1 325 Thread::wait(100);
gustavatmel 1:9c5af431a1f1 326 if (!testUnitReady())
gustavatmel 1:9c5af431a1f1 327 break;
gustavatmel 1:9c5af431a1f1 328 }
gustavatmel 1:9c5af431a1f1 329
gustavatmel 1:9c5af431a1f1 330 if (i == timeout) {
gustavatmel 1:9c5af431a1f1 331 disk_init = false;
gustavatmel 1:9c5af431a1f1 332 return -1;
gustavatmel 1:9c5af431a1f1 333 }
gustavatmel 1:9c5af431a1f1 334
gustavatmel 1:9c5af431a1f1 335 inquiry(0, 0);
gustavatmel 1:9c5af431a1f1 336 disk_init = 1;
gustavatmel 1:9c5af431a1f1 337 return readCapacity();
gustavatmel 1:9c5af431a1f1 338 }
gustavatmel 1:9c5af431a1f1 339
gustavatmel 1:9c5af431a1f1 340 int USBHostMSD::program(const void *buffer, bd_addr_t addr, bd_size_t size)
gustavatmel 1:9c5af431a1f1 341 {
gustavatmel 1:9c5af431a1f1 342 uint32_t block_number, count;
gustavatmel 1:9c5af431a1f1 343 uint8_t *buf = (uint8_t *)buffer;
gustavatmel 1:9c5af431a1f1 344 if (!disk_init) {
gustavatmel 1:9c5af431a1f1 345 init();
gustavatmel 1:9c5af431a1f1 346 }
gustavatmel 1:9c5af431a1f1 347 if (!disk_init) {
gustavatmel 1:9c5af431a1f1 348 return -1;
gustavatmel 1:9c5af431a1f1 349 }
gustavatmel 1:9c5af431a1f1 350 block_number = addr / blockSize;
gustavatmel 1:9c5af431a1f1 351 count = size /blockSize;
gustavatmel 1:9c5af431a1f1 352
gustavatmel 1:9c5af431a1f1 353 for (uint32_t b = block_number; b < block_number + count; b++) {
gustavatmel 1:9c5af431a1f1 354 if (dataTransfer(buf, b, 1, HOST_TO_DEVICE))
gustavatmel 1:9c5af431a1f1 355 return -1;
gustavatmel 1:9c5af431a1f1 356 buf += blockSize;
gustavatmel 1:9c5af431a1f1 357 }
gustavatmel 1:9c5af431a1f1 358 return 0;
gustavatmel 1:9c5af431a1f1 359 }
gustavatmel 1:9c5af431a1f1 360
gustavatmel 1:9c5af431a1f1 361 int USBHostMSD::read(void *buffer, bd_addr_t addr, bd_size_t size)
gustavatmel 1:9c5af431a1f1 362 {
gustavatmel 1:9c5af431a1f1 363 uint32_t block_number, count;
gustavatmel 1:9c5af431a1f1 364 uint8_t *buf = (uint8_t *)buffer;
gustavatmel 1:9c5af431a1f1 365 if (!disk_init) {
gustavatmel 1:9c5af431a1f1 366 init();
gustavatmel 1:9c5af431a1f1 367 }
gustavatmel 1:9c5af431a1f1 368 if (!disk_init) {
gustavatmel 1:9c5af431a1f1 369 return -1;
gustavatmel 1:9c5af431a1f1 370 }
gustavatmel 1:9c5af431a1f1 371 block_number = addr / blockSize;
gustavatmel 1:9c5af431a1f1 372 count = size / blockSize;
gustavatmel 1:9c5af431a1f1 373
gustavatmel 1:9c5af431a1f1 374 for (uint32_t b = block_number; b < block_number + count; b++) {
gustavatmel 1:9c5af431a1f1 375 if (dataTransfer(buf, b, 1, DEVICE_TO_HOST))
gustavatmel 1:9c5af431a1f1 376 return -1;
gustavatmel 1:9c5af431a1f1 377 buf += blockSize;
gustavatmel 1:9c5af431a1f1 378 }
gustavatmel 1:9c5af431a1f1 379 return 0;
gustavatmel 1:9c5af431a1f1 380 }
gustavatmel 1:9c5af431a1f1 381
gustavatmel 1:9c5af431a1f1 382 int USBHostMSD::erase(bd_addr_t addr, bd_size_t size)
gustavatmel 1:9c5af431a1f1 383 {
gustavatmel 1:9c5af431a1f1 384 return 0;
gustavatmel 1:9c5af431a1f1 385 }
gustavatmel 1:9c5af431a1f1 386
gustavatmel 1:9c5af431a1f1 387 bd_size_t USBHostMSD::get_read_size() const
gustavatmel 1:9c5af431a1f1 388 {
gustavatmel 1:9c5af431a1f1 389 return (disk_init ? (bd_size_t)blockSize : -1);
gustavatmel 1:9c5af431a1f1 390 }
gustavatmel 1:9c5af431a1f1 391
gustavatmel 1:9c5af431a1f1 392 bd_size_t USBHostMSD::get_program_size() const
gustavatmel 1:9c5af431a1f1 393 {
gustavatmel 1:9c5af431a1f1 394 return (disk_init ? (bd_size_t)blockSize : -1);
gustavatmel 1:9c5af431a1f1 395 }
gustavatmel 1:9c5af431a1f1 396 bd_size_t USBHostMSD::get_erase_size() const
gustavatmel 1:9c5af431a1f1 397 {
gustavatmel 1:9c5af431a1f1 398 return (disk_init ? (bd_size_t)blockSize : -1);
gustavatmel 1:9c5af431a1f1 399 }
gustavatmel 1:9c5af431a1f1 400
gustavatmel 1:9c5af431a1f1 401 bd_size_t USBHostMSD::size() const
gustavatmel 1:9c5af431a1f1 402 {
gustavatmel 1:9c5af431a1f1 403 USB_DBG("FILESYSTEM: size ");
gustavatmel 1:9c5af431a1f1 404 return (disk_init ? (bd_size_t)blockSize : 0);
gustavatmel 1:9c5af431a1f1 405 }
gustavatmel 1:9c5af431a1f1 406 #endif