Carlos Alberto Nascimento Filho / Mbed 2 deprecated MSCUsbHost_v2

I have errors with this program.

Dependencies:   mbed FATFileSystem

USBHostLite/usbhost_ms.c@0:ebf86c956c58, 2012-07-22 (annotated)

Committer:
carlos_nascimento08
Date:
Sun Jul 22 20:01:51 2012 +0000
Revision:
0:ebf86c956c58
Error debug

Who changed what in which revision?

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