den syu / Mbed 2 deprecated prgUSB2

esemi00

Dependencies:   mbed FatFileSystemCpp

USBHostLite/usbhost_ms.cpp@0:cfcd0d010286, 2021-01-20 (annotated)

Committer:
esemi00
Date:
Wed Jan 20 05:26:12 2021 +0000
Revision:
0:cfcd0d010286
esemi00

Who changed what in which revision?

UserRevisionLine numberNew contents of line
esemi00 0:cfcd0d010286 1 /*
esemi00 0:cfcd0d010286 2 **************************************************************************************************************
esemi00 0:cfcd0d010286 3 * NXP USB Host Stack
esemi00 0:cfcd0d010286 4 *
esemi00 0:cfcd0d010286 5 * (c) Copyright 2008, NXP SemiConductors
esemi00 0:cfcd0d010286 6 * (c) Copyright 2008, OnChip Technologies LLC
esemi00 0:cfcd0d010286 7 * All Rights Reserved
esemi00 0:cfcd0d010286 8 *
esemi00 0:cfcd0d010286 9 * www.nxp.com
esemi00 0:cfcd0d010286 10 * www.onchiptech.com
esemi00 0:cfcd0d010286 11 *
esemi00 0:cfcd0d010286 12 * File : usbhost_ms.c
esemi00 0:cfcd0d010286 13 * Programmer(s) : Ravikanth.P
esemi00 0:cfcd0d010286 14 * Version :
esemi00 0:cfcd0d010286 15 *
esemi00 0:cfcd0d010286 16 **************************************************************************************************************
esemi00 0:cfcd0d010286 17 */
esemi00 0:cfcd0d010286 18
esemi00 0:cfcd0d010286 19 /*
esemi00 0:cfcd0d010286 20 **************************************************************************************************************
esemi00 0:cfcd0d010286 21 * INCLUDE HEADER FILES
esemi00 0:cfcd0d010286 22 **************************************************************************************************************
esemi00 0:cfcd0d010286 23 */
esemi00 0:cfcd0d010286 24
esemi00 0:cfcd0d010286 25 #include "usbhost_ms.h"
esemi00 0:cfcd0d010286 26
esemi00 0:cfcd0d010286 27 /*
esemi00 0:cfcd0d010286 28 **************************************************************************************************************
esemi00 0:cfcd0d010286 29 * GLOBAL VARIABLES
esemi00 0:cfcd0d010286 30 **************************************************************************************************************
esemi00 0:cfcd0d010286 31 */
esemi00 0:cfcd0d010286 32
esemi00 0:cfcd0d010286 33 USB_INT32U MS_BlkSize;
esemi00 0:cfcd0d010286 34
esemi00 0:cfcd0d010286 35 /*
esemi00 0:cfcd0d010286 36 **************************************************************************************************************
esemi00 0:cfcd0d010286 37 * INITIALIZE MASS STORAGE INTERFACE
esemi00 0:cfcd0d010286 38 *
esemi00 0:cfcd0d010286 39 * Description: This function initializes the mass storage interface
esemi00 0:cfcd0d010286 40 *
esemi00 0:cfcd0d010286 41 * Arguments : None
esemi00 0:cfcd0d010286 42 *
esemi00 0:cfcd0d010286 43 * Returns : OK if Success
esemi00 0:cfcd0d010286 44 * ERR_INVALID_BOOTSIG if Failed
esemi00 0:cfcd0d010286 45 *
esemi00 0:cfcd0d010286 46 **************************************************************************************************************
esemi00 0:cfcd0d010286 47 */
esemi00 0:cfcd0d010286 48
esemi00 0:cfcd0d010286 49 USB_INT32S MS_Init (USB_INT32U *blkSize, USB_INT32U *numBlks, USB_INT08U *inquiryResult)
esemi00 0:cfcd0d010286 50 {
esemi00 0:cfcd0d010286 51 USB_INT08U retry;
esemi00 0:cfcd0d010286 52 USB_INT32S rc;
esemi00 0:cfcd0d010286 53
esemi00 0:cfcd0d010286 54 MS_GetMaxLUN(); /* Get maximum logical unit number */
esemi00 0:cfcd0d010286 55 retry = 80;
esemi00 0:cfcd0d010286 56 while(retry) {
esemi00 0:cfcd0d010286 57 rc = MS_TestUnitReady(); /* Test whether the unit is ready */
esemi00 0:cfcd0d010286 58 if (rc == OK) {
esemi00 0:cfcd0d010286 59 break;
esemi00 0:cfcd0d010286 60 }
esemi00 0:cfcd0d010286 61 MS_GetSenseInfo(); /* Get sense information */
esemi00 0:cfcd0d010286 62 retry--;
esemi00 0:cfcd0d010286 63 }
esemi00 0:cfcd0d010286 64 if (rc != OK) {
esemi00 0:cfcd0d010286 65 PRINT_Err(rc);
esemi00 0:cfcd0d010286 66 return (rc);
esemi00 0:cfcd0d010286 67 }
esemi00 0:cfcd0d010286 68 rc = MS_ReadCapacity(numBlks, blkSize); /* Read capacity of the disk */
esemi00 0:cfcd0d010286 69 MS_BlkSize = *blkSize; // Set global
esemi00 0:cfcd0d010286 70 rc = MS_Inquire (inquiryResult);
esemi00 0:cfcd0d010286 71 return (rc);
esemi00 0:cfcd0d010286 72 }
esemi00 0:cfcd0d010286 73 /*
esemi00 0:cfcd0d010286 74 **************************************************************************************************************
esemi00 0:cfcd0d010286 75 * PARSE THE CONFIGURATION
esemi00 0:cfcd0d010286 76 *
esemi00 0:cfcd0d010286 77 * Description: This function is used to parse the configuration
esemi00 0:cfcd0d010286 78 *
esemi00 0:cfcd0d010286 79 * Arguments : None
esemi00 0:cfcd0d010286 80 *
esemi00 0:cfcd0d010286 81 * Returns : OK if Success
esemi00 0:cfcd0d010286 82 * ERR_INVALID_BOOTSIG if Failed
esemi00 0:cfcd0d010286 83 *
esemi00 0:cfcd0d010286 84 **************************************************************************************************************
esemi00 0:cfcd0d010286 85 */
esemi00 0:cfcd0d010286 86
esemi00 0:cfcd0d010286 87 USB_INT32S MS_ParseConfiguration (void)
esemi00 0:cfcd0d010286 88 {
esemi00 0:cfcd0d010286 89 volatile USB_INT08U *desc_ptr;
esemi00 0:cfcd0d010286 90 USB_INT08U ms_int_found;
esemi00 0:cfcd0d010286 91
esemi00 0:cfcd0d010286 92
esemi00 0:cfcd0d010286 93 desc_ptr = TDBuffer;
esemi00 0:cfcd0d010286 94 ms_int_found = 0;
esemi00 0:cfcd0d010286 95
esemi00 0:cfcd0d010286 96 if (desc_ptr[1] != USB_DESCRIPTOR_TYPE_CONFIGURATION) {
esemi00 0:cfcd0d010286 97 return (ERR_BAD_CONFIGURATION);
esemi00 0:cfcd0d010286 98 }
esemi00 0:cfcd0d010286 99 desc_ptr += desc_ptr[0];
esemi00 0:cfcd0d010286 100
esemi00 0:cfcd0d010286 101 while (desc_ptr != TDBuffer + ReadLE16U(&TDBuffer[2])) {
esemi00 0:cfcd0d010286 102
esemi00 0:cfcd0d010286 103 switch (desc_ptr[1]) {
esemi00 0:cfcd0d010286 104
esemi00 0:cfcd0d010286 105 case USB_DESCRIPTOR_TYPE_INTERFACE: /* If it is an interface descriptor */
esemi00 0:cfcd0d010286 106 if (desc_ptr[5] == MASS_STORAGE_CLASS && /* check if the class is mass storage */
esemi00 0:cfcd0d010286 107 desc_ptr[6] == MASS_STORAGE_SUBCLASS_SCSI && /* check if the subclass is SCSI */
esemi00 0:cfcd0d010286 108 desc_ptr[7] == MASS_STORAGE_PROTOCOL_BO) { /* check if the protocol is Bulk only */
esemi00 0:cfcd0d010286 109 ms_int_found = 1;
esemi00 0:cfcd0d010286 110 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
esemi00 0:cfcd0d010286 111 }
esemi00 0:cfcd0d010286 112 break;
esemi00 0:cfcd0d010286 113
esemi00 0:cfcd0d010286 114 case USB_DESCRIPTOR_TYPE_ENDPOINT: /* If it is an endpoint descriptor */
esemi00 0:cfcd0d010286 115 if ((desc_ptr[3] & 0x03) == 0x02) { /* If it is Bulk endpoint */
esemi00 0:cfcd0d010286 116 if (desc_ptr[2] & 0x80) { /* If it is In endpoint */
esemi00 0:cfcd0d010286 117 EDBulkIn->Control = 1 | /* USB address */
esemi00 0:cfcd0d010286 118 ((desc_ptr[2] & 0x7F) << 7) | /* Endpoint address */
esemi00 0:cfcd0d010286 119 (2 << 11) | /* direction */
esemi00 0:cfcd0d010286 120 (ReadLE16U(&desc_ptr[4]) << 16); /* MaxPkt Size */
esemi00 0:cfcd0d010286 121 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
esemi00 0:cfcd0d010286 122 } else { /* If it is Out endpoint */
esemi00 0:cfcd0d010286 123 EDBulkOut->Control = 1 | /* USB address */
esemi00 0:cfcd0d010286 124 ((desc_ptr[2] & 0x7F) << 7) | /* Endpoint address */
esemi00 0:cfcd0d010286 125 (1 << 11) | /* direction */
esemi00 0:cfcd0d010286 126 (ReadLE16U(&desc_ptr[4]) << 16); /* MaxPkt Size */
esemi00 0:cfcd0d010286 127 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
esemi00 0:cfcd0d010286 128 }
esemi00 0:cfcd0d010286 129 } else { /* If it is not bulk end point */
esemi00 0:cfcd0d010286 130 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
esemi00 0:cfcd0d010286 131 }
esemi00 0:cfcd0d010286 132 break;
esemi00 0:cfcd0d010286 133
esemi00 0:cfcd0d010286 134 default: /* If the descriptor is neither interface nor endpoint */
esemi00 0:cfcd0d010286 135 desc_ptr += desc_ptr[0]; /* Move to next descriptor start */
esemi00 0:cfcd0d010286 136 break;
esemi00 0:cfcd0d010286 137 }
esemi00 0:cfcd0d010286 138 }
esemi00 0:cfcd0d010286 139 if (ms_int_found) {
esemi00 0:cfcd0d010286 140 PRINT_Log("Mass Storage device connected\n");
esemi00 0:cfcd0d010286 141 return (OK);
esemi00 0:cfcd0d010286 142 } else {
esemi00 0:cfcd0d010286 143 PRINT_Log("Not a Mass Storage device\n");
esemi00 0:cfcd0d010286 144 return (ERR_NO_MS_INTERFACE);
esemi00 0:cfcd0d010286 145 }
esemi00 0:cfcd0d010286 146 }
esemi00 0:cfcd0d010286 147
esemi00 0:cfcd0d010286 148 /*
esemi00 0:cfcd0d010286 149 **************************************************************************************************************
esemi00 0:cfcd0d010286 150 * GET MAXIMUM LOGICAL UNIT
esemi00 0:cfcd0d010286 151 *
esemi00 0:cfcd0d010286 152 * Description: This function returns the maximum logical unit from the device
esemi00 0:cfcd0d010286 153 *
esemi00 0:cfcd0d010286 154 * Arguments : None
esemi00 0:cfcd0d010286 155 *
esemi00 0:cfcd0d010286 156 * Returns : OK if Success
esemi00 0:cfcd0d010286 157 * ERR_INVALID_BOOTSIG if Failed
esemi00 0:cfcd0d010286 158 *
esemi00 0:cfcd0d010286 159 **************************************************************************************************************
esemi00 0:cfcd0d010286 160 */
esemi00 0:cfcd0d010286 161
esemi00 0:cfcd0d010286 162 USB_INT32S MS_GetMaxLUN (void)
esemi00 0:cfcd0d010286 163 {
esemi00 0:cfcd0d010286 164 USB_INT32S rc;
esemi00 0:cfcd0d010286 165
esemi00 0:cfcd0d010286 166
esemi00 0:cfcd0d010286 167 rc = Host_CtrlRecv(USB_DEVICE_TO_HOST | USB_REQUEST_TYPE_CLASS | USB_RECIPIENT_INTERFACE,
esemi00 0:cfcd0d010286 168 MS_GET_MAX_LUN_REQ,
esemi00 0:cfcd0d010286 169 0,
esemi00 0:cfcd0d010286 170 0,
esemi00 0:cfcd0d010286 171 1,
esemi00 0:cfcd0d010286 172 TDBuffer);
esemi00 0:cfcd0d010286 173 return (rc);
esemi00 0:cfcd0d010286 174 }
esemi00 0:cfcd0d010286 175
esemi00 0:cfcd0d010286 176 /*
esemi00 0:cfcd0d010286 177 **************************************************************************************************************
esemi00 0:cfcd0d010286 178 * GET SENSE INFORMATION
esemi00 0:cfcd0d010286 179 *
esemi00 0:cfcd0d010286 180 * Description: This function is used to get sense information from the device
esemi00 0:cfcd0d010286 181 *
esemi00 0:cfcd0d010286 182 * Arguments : None
esemi00 0:cfcd0d010286 183 *
esemi00 0:cfcd0d010286 184 * Returns : OK if Success
esemi00 0:cfcd0d010286 185 * ERROR if Failed
esemi00 0:cfcd0d010286 186 *
esemi00 0:cfcd0d010286 187 **************************************************************************************************************
esemi00 0:cfcd0d010286 188 */
esemi00 0:cfcd0d010286 189
esemi00 0:cfcd0d010286 190 USB_INT32S MS_GetSenseInfo (void)
esemi00 0:cfcd0d010286 191 {
esemi00 0:cfcd0d010286 192 USB_INT32S rc;
esemi00 0:cfcd0d010286 193
esemi00 0:cfcd0d010286 194
esemi00 0:cfcd0d010286 195 Fill_MSCommand(0, 0, 0, MS_DATA_DIR_IN, SCSI_CMD_REQUEST_SENSE, 6);
esemi00 0:cfcd0d010286 196 rc = Host_ProcessTD(EDBulkOut, TD_OUT, TDBuffer, CBW_SIZE);
esemi00 0:cfcd0d010286 197 if (rc == OK) {
esemi00 0:cfcd0d010286 198 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, 18);
esemi00 0:cfcd0d010286 199 if (rc == OK) {
esemi00 0:cfcd0d010286 200 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, CSW_SIZE);
esemi00 0:cfcd0d010286 201 if (rc == OK) {
esemi00 0:cfcd0d010286 202 if (TDBuffer[12] != 0) {
esemi00 0:cfcd0d010286 203 rc = ERR_MS_CMD_FAILED;
esemi00 0:cfcd0d010286 204 }
esemi00 0:cfcd0d010286 205 }
esemi00 0:cfcd0d010286 206 }
esemi00 0:cfcd0d010286 207 }
esemi00 0:cfcd0d010286 208 return (rc);
esemi00 0:cfcd0d010286 209 }
esemi00 0:cfcd0d010286 210
esemi00 0:cfcd0d010286 211 /*
esemi00 0:cfcd0d010286 212 **************************************************************************************************************
esemi00 0:cfcd0d010286 213 * TEST UNIT READY
esemi00 0:cfcd0d010286 214 *
esemi00 0:cfcd0d010286 215 * Description: This function is used to test whether the unit is ready or not
esemi00 0:cfcd0d010286 216 *
esemi00 0:cfcd0d010286 217 * Arguments : None
esemi00 0:cfcd0d010286 218 *
esemi00 0:cfcd0d010286 219 * Returns : OK if Success
esemi00 0:cfcd0d010286 220 * ERROR if Failed
esemi00 0:cfcd0d010286 221 *
esemi00 0:cfcd0d010286 222 **************************************************************************************************************
esemi00 0:cfcd0d010286 223 */
esemi00 0:cfcd0d010286 224
esemi00 0:cfcd0d010286 225 USB_INT32S MS_TestUnitReady (void)
esemi00 0:cfcd0d010286 226 {
esemi00 0:cfcd0d010286 227 USB_INT32S rc;
esemi00 0:cfcd0d010286 228
esemi00 0:cfcd0d010286 229
esemi00 0:cfcd0d010286 230 Fill_MSCommand(0, 0, 0, MS_DATA_DIR_NONE, SCSI_CMD_TEST_UNIT_READY, 6);
esemi00 0:cfcd0d010286 231 rc = Host_ProcessTD(EDBulkOut, TD_OUT, TDBuffer, CBW_SIZE);
esemi00 0:cfcd0d010286 232 if (rc == OK) {
esemi00 0:cfcd0d010286 233 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, CSW_SIZE);
esemi00 0:cfcd0d010286 234 if (rc == OK) {
esemi00 0:cfcd0d010286 235 if (TDBuffer[12] != 0) {
esemi00 0:cfcd0d010286 236 rc = ERR_MS_CMD_FAILED;
esemi00 0:cfcd0d010286 237 }
esemi00 0:cfcd0d010286 238 }
esemi00 0:cfcd0d010286 239 }
esemi00 0:cfcd0d010286 240 return (rc);
esemi00 0:cfcd0d010286 241 }
esemi00 0:cfcd0d010286 242
esemi00 0:cfcd0d010286 243 /*
esemi00 0:cfcd0d010286 244 **************************************************************************************************************
esemi00 0:cfcd0d010286 245 * READ CAPACITY
esemi00 0:cfcd0d010286 246 *
esemi00 0:cfcd0d010286 247 * Description: This function is used to read the capacity of the mass storage device
esemi00 0:cfcd0d010286 248 *
esemi00 0:cfcd0d010286 249 * Arguments : None
esemi00 0:cfcd0d010286 250 *
esemi00 0:cfcd0d010286 251 * Returns : OK if Success
esemi00 0:cfcd0d010286 252 * ERROR if Failed
esemi00 0:cfcd0d010286 253 *
esemi00 0:cfcd0d010286 254 **************************************************************************************************************
esemi00 0:cfcd0d010286 255 */
esemi00 0:cfcd0d010286 256
esemi00 0:cfcd0d010286 257 USB_INT32S MS_ReadCapacity (USB_INT32U *numBlks, USB_INT32U *blkSize)
esemi00 0:cfcd0d010286 258 {
esemi00 0:cfcd0d010286 259 USB_INT32S rc;
esemi00 0:cfcd0d010286 260
esemi00 0:cfcd0d010286 261
esemi00 0:cfcd0d010286 262 Fill_MSCommand(0, 0, 0, MS_DATA_DIR_IN, SCSI_CMD_READ_CAPACITY, 10);
esemi00 0:cfcd0d010286 263 rc = Host_ProcessTD(EDBulkOut, TD_OUT, TDBuffer, CBW_SIZE);
esemi00 0:cfcd0d010286 264 if (rc == OK) {
esemi00 0:cfcd0d010286 265 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, 8);
esemi00 0:cfcd0d010286 266 if (rc == OK) {
esemi00 0:cfcd0d010286 267 if (numBlks)
esemi00 0:cfcd0d010286 268 *numBlks = ReadBE32U(&TDBuffer[0]);
esemi00 0:cfcd0d010286 269 if (blkSize)
esemi00 0:cfcd0d010286 270 *blkSize = ReadBE32U(&TDBuffer[4]);
esemi00 0:cfcd0d010286 271 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, CSW_SIZE);
esemi00 0:cfcd0d010286 272 if (rc == OK) {
esemi00 0:cfcd0d010286 273 if (TDBuffer[12] != 0) {
esemi00 0:cfcd0d010286 274 rc = ERR_MS_CMD_FAILED;
esemi00 0:cfcd0d010286 275 }
esemi00 0:cfcd0d010286 276 }
esemi00 0:cfcd0d010286 277 }
esemi00 0:cfcd0d010286 278 }
esemi00 0:cfcd0d010286 279 return (rc);
esemi00 0:cfcd0d010286 280 }
esemi00 0:cfcd0d010286 281
esemi00 0:cfcd0d010286 282
esemi00 0:cfcd0d010286 283
esemi00 0:cfcd0d010286 284 USB_INT32S MS_Inquire (USB_INT08U *response)
esemi00 0:cfcd0d010286 285 {
esemi00 0:cfcd0d010286 286 USB_INT32S rc;
esemi00 0:cfcd0d010286 287 USB_INT32U i;
esemi00 0:cfcd0d010286 288
esemi00 0:cfcd0d010286 289 Fill_MSCommand(0, 0, 0, MS_DATA_DIR_IN, SCSI_CMD_INQUIRY, 6);
esemi00 0:cfcd0d010286 290 rc = Host_ProcessTD(EDBulkOut, TD_OUT, TDBuffer, CBW_SIZE);
esemi00 0:cfcd0d010286 291 if (rc == OK) {
esemi00 0:cfcd0d010286 292 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, INQUIRY_LENGTH);
esemi00 0:cfcd0d010286 293 if (rc == OK) {
esemi00 0:cfcd0d010286 294 if (response) {
esemi00 0:cfcd0d010286 295 for ( i = 0; i < INQUIRY_LENGTH; i++ )
esemi00 0:cfcd0d010286 296 *response++ = *TDBuffer++;
esemi00 0:cfcd0d010286 297 #if 0
esemi00 0:cfcd0d010286 298 MemCpy (response, TDBuffer, INQUIRY_LENGTH);
esemi00 0:cfcd0d010286 299 StrNullTrailingSpace (response->vendorID, SCSI_INQUIRY_VENDORCHARS);
esemi00 0:cfcd0d010286 300 StrNullTrailingSpace (response->productID, SCSI_INQUIRY_PRODUCTCHARS);
esemi00 0:cfcd0d010286 301 StrNullTrailingSpace (response->productRev, SCSI_INQUIRY_REVCHARS);
esemi00 0:cfcd0d010286 302 #endif
esemi00 0:cfcd0d010286 303 }
esemi00 0:cfcd0d010286 304 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, CSW_SIZE);
esemi00 0:cfcd0d010286 305 if (rc == OK) {
esemi00 0:cfcd0d010286 306 if (TDBuffer[12] != 0) { // bCSWStatus byte
esemi00 0:cfcd0d010286 307 rc = ERR_MS_CMD_FAILED;
esemi00 0:cfcd0d010286 308 }
esemi00 0:cfcd0d010286 309 }
esemi00 0:cfcd0d010286 310 }
esemi00 0:cfcd0d010286 311 }
esemi00 0:cfcd0d010286 312 return (rc);
esemi00 0:cfcd0d010286 313 }
esemi00 0:cfcd0d010286 314
esemi00 0:cfcd0d010286 315 /*
esemi00 0:cfcd0d010286 316 **************************************************************************************************************
esemi00 0:cfcd0d010286 317 * RECEIVE THE BULK DATA
esemi00 0:cfcd0d010286 318 *
esemi00 0:cfcd0d010286 319 * Description: This function is used to receive the bulk data
esemi00 0:cfcd0d010286 320 *
esemi00 0:cfcd0d010286 321 * Arguments : None
esemi00 0:cfcd0d010286 322 *
esemi00 0:cfcd0d010286 323 * Returns : OK if Success
esemi00 0:cfcd0d010286 324 * ERR_INVALID_BOOTSIG if Failed
esemi00 0:cfcd0d010286 325 *
esemi00 0:cfcd0d010286 326 **************************************************************************************************************
esemi00 0:cfcd0d010286 327 */
esemi00 0:cfcd0d010286 328
esemi00 0:cfcd0d010286 329 USB_INT32S MS_BulkRecv ( USB_INT32U block_number,
esemi00 0:cfcd0d010286 330 USB_INT16U num_blocks,
esemi00 0:cfcd0d010286 331 volatile USB_INT08U *user_buffer)
esemi00 0:cfcd0d010286 332 {
esemi00 0:cfcd0d010286 333 USB_INT32S rc;
esemi00 0:cfcd0d010286 334 int i;
esemi00 0:cfcd0d010286 335 volatile USB_INT08U *c = user_buffer;
esemi00 0:cfcd0d010286 336 for (i=0;i<MS_BlkSize*num_blocks;i++)
esemi00 0:cfcd0d010286 337 *c++ = 0;
esemi00 0:cfcd0d010286 338
esemi00 0:cfcd0d010286 339
esemi00 0:cfcd0d010286 340 Fill_MSCommand(block_number, MS_BlkSize, num_blocks, MS_DATA_DIR_IN, SCSI_CMD_READ_10, 10);
esemi00 0:cfcd0d010286 341
esemi00 0:cfcd0d010286 342 rc = Host_ProcessTD(EDBulkOut, TD_OUT, TDBuffer, CBW_SIZE);
esemi00 0:cfcd0d010286 343 if (rc == OK) {
esemi00 0:cfcd0d010286 344 rc = Host_ProcessTD(EDBulkIn, TD_IN, user_buffer, MS_BlkSize * num_blocks);
esemi00 0:cfcd0d010286 345 if (rc == OK) {
esemi00 0:cfcd0d010286 346 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, CSW_SIZE);
esemi00 0:cfcd0d010286 347 if (rc == OK) {
esemi00 0:cfcd0d010286 348 if (TDBuffer[12] != 0) {
esemi00 0:cfcd0d010286 349 rc = ERR_MS_CMD_FAILED;
esemi00 0:cfcd0d010286 350 }
esemi00 0:cfcd0d010286 351 }
esemi00 0:cfcd0d010286 352 }
esemi00 0:cfcd0d010286 353 }
esemi00 0:cfcd0d010286 354 return (rc);
esemi00 0:cfcd0d010286 355 }
esemi00 0:cfcd0d010286 356
esemi00 0:cfcd0d010286 357 /*
esemi00 0:cfcd0d010286 358 **************************************************************************************************************
esemi00 0:cfcd0d010286 359 * SEND BULK DATA
esemi00 0:cfcd0d010286 360 *
esemi00 0:cfcd0d010286 361 * Description: This function is used to send the bulk data
esemi00 0:cfcd0d010286 362 *
esemi00 0:cfcd0d010286 363 * Arguments : None
esemi00 0:cfcd0d010286 364 *
esemi00 0:cfcd0d010286 365 * Returns : OK if Success
esemi00 0:cfcd0d010286 366 * ERR_INVALID_BOOTSIG if Failed
esemi00 0:cfcd0d010286 367 *
esemi00 0:cfcd0d010286 368 **************************************************************************************************************
esemi00 0:cfcd0d010286 369 */
esemi00 0:cfcd0d010286 370
esemi00 0:cfcd0d010286 371 USB_INT32S MS_BulkSend ( USB_INT32U block_number,
esemi00 0:cfcd0d010286 372 USB_INT16U num_blocks,
esemi00 0:cfcd0d010286 373 volatile USB_INT08U *user_buffer)
esemi00 0:cfcd0d010286 374 {
esemi00 0:cfcd0d010286 375 USB_INT32S rc;
esemi00 0:cfcd0d010286 376
esemi00 0:cfcd0d010286 377
esemi00 0:cfcd0d010286 378 Fill_MSCommand(block_number, MS_BlkSize, num_blocks, MS_DATA_DIR_OUT, SCSI_CMD_WRITE_10, 10);
esemi00 0:cfcd0d010286 379
esemi00 0:cfcd0d010286 380 rc = Host_ProcessTD(EDBulkOut, TD_OUT, TDBuffer, CBW_SIZE);
esemi00 0:cfcd0d010286 381 if (rc == OK) {
esemi00 0:cfcd0d010286 382 rc = Host_ProcessTD(EDBulkOut, TD_OUT, user_buffer, MS_BlkSize * num_blocks);
esemi00 0:cfcd0d010286 383 if (rc == OK) {
esemi00 0:cfcd0d010286 384 rc = Host_ProcessTD(EDBulkIn, TD_IN, TDBuffer, CSW_SIZE);
esemi00 0:cfcd0d010286 385 if (rc == OK) {
esemi00 0:cfcd0d010286 386 if (TDBuffer[12] != 0) {
esemi00 0:cfcd0d010286 387 rc = ERR_MS_CMD_FAILED;
esemi00 0:cfcd0d010286 388 }
esemi00 0:cfcd0d010286 389 }
esemi00 0:cfcd0d010286 390 }
esemi00 0:cfcd0d010286 391 }
esemi00 0:cfcd0d010286 392 return (rc);
esemi00 0:cfcd0d010286 393 }
esemi00 0:cfcd0d010286 394
esemi00 0:cfcd0d010286 395 /*
esemi00 0:cfcd0d010286 396 **************************************************************************************************************
esemi00 0:cfcd0d010286 397 * FILL MASS STORAGE COMMAND
esemi00 0:cfcd0d010286 398 *
esemi00 0:cfcd0d010286 399 * Description: This function is used to fill the mass storage command
esemi00 0:cfcd0d010286 400 *
esemi00 0:cfcd0d010286 401 * Arguments : None
esemi00 0:cfcd0d010286 402 *
esemi00 0:cfcd0d010286 403 * Returns : OK if Success
esemi00 0:cfcd0d010286 404 * ERR_INVALID_BOOTSIG if Failed
esemi00 0:cfcd0d010286 405 *
esemi00 0:cfcd0d010286 406 **************************************************************************************************************
esemi00 0:cfcd0d010286 407 */
esemi00 0:cfcd0d010286 408
esemi00 0:cfcd0d010286 409 void Fill_MSCommand (USB_INT32U block_number,
esemi00 0:cfcd0d010286 410 USB_INT32U block_size,
esemi00 0:cfcd0d010286 411 USB_INT16U num_blocks,
esemi00 0:cfcd0d010286 412 MS_DATA_DIR direction,
esemi00 0:cfcd0d010286 413 USB_INT08U scsi_cmd,
esemi00 0:cfcd0d010286 414 USB_INT08U scsi_cmd_len)
esemi00 0:cfcd0d010286 415 {
esemi00 0:cfcd0d010286 416 USB_INT32U data_len;
esemi00 0:cfcd0d010286 417 static USB_INT32U tag_cnt = 0;
esemi00 0:cfcd0d010286 418 USB_INT32U cnt;
esemi00 0:cfcd0d010286 419
esemi00 0:cfcd0d010286 420
esemi00 0:cfcd0d010286 421 for (cnt = 0; cnt < CBW_SIZE; cnt++) {
esemi00 0:cfcd0d010286 422 TDBuffer[cnt] = 0;
esemi00 0:cfcd0d010286 423 }
esemi00 0:cfcd0d010286 424 switch(scsi_cmd) {
esemi00 0:cfcd0d010286 425
esemi00 0:cfcd0d010286 426 case SCSI_CMD_TEST_UNIT_READY:
esemi00 0:cfcd0d010286 427 data_len = 0;
esemi00 0:cfcd0d010286 428 break;
esemi00 0:cfcd0d010286 429 case SCSI_CMD_READ_CAPACITY:
esemi00 0:cfcd0d010286 430 data_len = 8;
esemi00 0:cfcd0d010286 431 break;
esemi00 0:cfcd0d010286 432 case SCSI_CMD_REQUEST_SENSE:
esemi00 0:cfcd0d010286 433 data_len = 18;
esemi00 0:cfcd0d010286 434 break;
esemi00 0:cfcd0d010286 435 case SCSI_CMD_INQUIRY:
esemi00 0:cfcd0d010286 436 data_len = 36;
esemi00 0:cfcd0d010286 437 break;
esemi00 0:cfcd0d010286 438 default:
esemi00 0:cfcd0d010286 439 data_len = block_size * num_blocks;
esemi00 0:cfcd0d010286 440 break;
esemi00 0:cfcd0d010286 441 }
esemi00 0:cfcd0d010286 442 WriteLE32U(TDBuffer, CBW_SIGNATURE);
esemi00 0:cfcd0d010286 443 WriteLE32U(&TDBuffer[4], tag_cnt);
esemi00 0:cfcd0d010286 444 WriteLE32U(&TDBuffer[8], data_len);
esemi00 0:cfcd0d010286 445 TDBuffer[12] = (direction == MS_DATA_DIR_NONE) ? 0 : direction;
esemi00 0:cfcd0d010286 446 TDBuffer[14] = scsi_cmd_len; /* Length of the CBW */
esemi00 0:cfcd0d010286 447 TDBuffer[15] = scsi_cmd;
esemi00 0:cfcd0d010286 448 if ((scsi_cmd == SCSI_CMD_REQUEST_SENSE)
esemi00 0:cfcd0d010286 449 || (scsi_cmd == SCSI_CMD_INQUIRY)) {
esemi00 0:cfcd0d010286 450 TDBuffer[19] = (USB_INT08U)data_len;
esemi00 0:cfcd0d010286 451 } else {
esemi00 0:cfcd0d010286 452 WriteBE32U(&TDBuffer[17], block_number);
esemi00 0:cfcd0d010286 453 }
esemi00 0:cfcd0d010286 454 WriteBE16U(&TDBuffer[22], num_blocks);
esemi00 0:cfcd0d010286 455 }