Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039 #include "SBCMethods.h"
00040 #include "MSDDStateMachine.h"
00041 #include "USBD_HAL.h"
00042 #include "chip.h"
00043
00044
00045
00046
00047
00048
00049
00050
00051
00052
00053
00054
00055 static void MSDDriver_Callback(MSDTransfer *transfer,
00056 uint8_t status,
00057 uint32_t transferred,
00058 uint32_t remaining)
00059 {
00060 if (transfer->semaphore == 0) {
00061 transfer->semaphore++;
00062 transfer->status = status;
00063 transfer->transferred = transferred;
00064 transfer->remaining = remaining;
00065 }
00066 }
00067
00068
00069
00070
00071
00072
00073
00074
00075 static void MSDD_GetCommandInformation(MSCbw *cbw,
00076 unsigned int *length,
00077 unsigned char *type)
00078 {
00079
00080 (*length) = cbw->dCBWDataTransferLength;
00081
00082 if (*length == 0)
00083
00084 (*type) = MSDD_NO_TRANSFER;
00085 else if ((cbw->bmCBWFlags & MSD_CBW_DEVICE_TO_HOST) != 0)
00086
00087 (*type) = MSDD_DEVICE_TO_HOST;
00088 else
00089
00090 (*type) = MSDD_HOST_TO_DEVICE;
00091 }
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102 static unsigned char MSDD_PreProcessCommand(MSDDriver *pMsdDriver)
00103 {
00104 unsigned int hostLength = 0;
00105 unsigned int deviceLength = 0;
00106 unsigned char hostType;
00107 unsigned char deviceType;
00108 unsigned char isCommandSupported;
00109 MSDCommandState *commandState = &(pMsdDriver->commandState);
00110 MSCsw *csw = &(commandState->csw);
00111 MSCbw *cbw = &(commandState->cbw);
00112 MSDLun *lun = &(pMsdDriver->luns[(unsigned char) cbw->bCBWLUN]);
00113
00114
00115
00116 MSDD_GetCommandInformation(cbw, &hostLength, &hostType);
00117
00118
00119 isCommandSupported = SBC_GetCommandInformation(cbw->pCommand,
00120 &deviceLength,
00121 &deviceType,
00122 lun);
00123
00124
00125 csw->dCSWDataResidue = 0;
00126 csw->bCSWStatus = MSD_CSW_COMMAND_PASSED;
00127
00128
00129 if (isCommandSupported) {
00130
00131
00132 if (hostType == MSDD_NO_TRANSFER) {
00133
00134
00135 if (deviceType == MSDD_NO_TRANSFER) {
00136
00137
00138 commandState->postprocess = 0;
00139 commandState->length = 0;
00140 csw->bCSWStatus = MSD_CSW_COMMAND_PASSED;
00141 } else if (deviceType == MSDD_DEVICE_TO_HOST) {
00142
00143
00144 TRACE_WARNING(
00145 "MSDD_PreProcessCommand: Case 2\n\r");
00146 commandState->postprocess = MSDD_CASE_STALL_IN;
00147 commandState->length = 0;
00148 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00149 } else {
00150
00151
00152 TRACE_WARNING(
00153 "MSDD_PreProcessCommand: Case 3\n\r");
00154 commandState->postprocess = MSDD_CASE_STALL_IN;
00155 commandState->length = 0;
00156 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00157 }
00158 }
00159
00160
00161 else if (hostType == MSDD_DEVICE_TO_HOST) {
00162
00163 if (deviceType == MSDD_NO_TRANSFER) {
00164
00165 TRACE_WARNING(
00166 "MSDD_PreProcessCommand: Case 4\n\r");
00167 commandState->postprocess = MSDD_CASE_STALL_IN;
00168 commandState->length = 0;
00169 csw->dCSWDataResidue = hostLength;
00170 } else if (deviceType == MSDD_DEVICE_TO_HOST) {
00171
00172 if (hostLength > deviceLength) {
00173
00174
00175 TRACE_WARNING(
00176 "MSDD_PreProcessCommand: Case 5\n\r");
00177 commandState->postprocess = MSDD_CASE_STALL_IN;
00178 commandState->length = deviceLength;
00179 csw->dCSWDataResidue = hostLength - deviceLength;
00180 } else if (hostLength == deviceLength) {
00181
00182
00183 commandState->postprocess = 0;
00184 commandState->length = deviceLength;
00185 } else {
00186
00187
00188 TRACE_WARNING(
00189 "MSDD_PreProcessCommand: Case 7\n\r");
00190 commandState->postprocess = MSDD_CASE_STALL_IN;
00191 commandState->length = hostLength;
00192 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00193 }
00194 } else {
00195
00196
00197 TRACE_WARNING(
00198 "MSDD_PreProcessCommand: Case 8\n\r");
00199 commandState->postprocess = MSDD_CASE_STALL_IN;
00200 commandState->length = 0;
00201 csw->dCSWDataResidue = hostLength;
00202 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00203 }
00204 } else if (hostType == MSDD_HOST_TO_DEVICE) {
00205
00206 if (deviceType == MSDD_NO_TRANSFER) {
00207
00208
00209 TRACE_WARNING(
00210 "MSDD_PreProcessCommand: Case 9\n\r");
00211 commandState->postprocess = MSDD_CASE_STALL_OUT;
00212 commandState->length = 0;
00213 csw->dCSWDataResidue = hostLength;
00214 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00215 } else if (deviceType == MSDD_DEVICE_TO_HOST) {
00216
00217
00218 TRACE_WARNING(
00219 "MSDD_PreProcessCommand: Case 10\n\r");
00220 commandState->postprocess =
00221 MSDD_CASE_STALL_OUT;
00222 commandState->length = 0;
00223 csw->dCSWDataResidue = hostLength;
00224 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00225 } else {
00226
00227 if (hostLength > deviceLength) {
00228
00229
00230 TRACE_WARNING(
00231 "MSDD_PreProcessCommand: Case 11\n\r");
00232 commandState->postprocess = MSDD_CASE_STALL_OUT;
00233
00234
00235 commandState->length = 0;
00236 csw->dCSWDataResidue = deviceLength;
00237 } else if (hostLength == deviceLength) {
00238
00239
00240
00241
00242 commandState->postprocess = 0;
00243 commandState->length = deviceLength;
00244 } else {
00245
00246
00247 TRACE_WARNING(
00248 "MSDD_PreProcessCommand: Case 13\n\r");
00249 commandState->postprocess = MSDD_CASE_STALL_OUT;
00250 commandState->length = hostLength;
00251 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00252 }
00253 }
00254 }
00255 }
00256
00257 return isCommandSupported;
00258 }
00259
00260
00261
00262
00263
00264
00265
00266
00267
00268
00269
00270 static unsigned char MSDD_PostProcessCommand(MSDDriver *pMsdDriver)
00271 {
00272 MSDCommandState *commandState = &(pMsdDriver->commandState);
00273 MSCsw *csw = &(commandState->csw);
00274 unsigned char haltStatus = 0;
00275
00276
00277 if ((commandState->postprocess & MSDD_CASE_PHASE_ERROR) != 0) {
00278
00279 TRACE_INFO_WP("PhaseErr ");
00280 csw->bCSWStatus = MSD_CSW_PHASE_ERROR;
00281 }
00282
00283
00284 if (((commandState->postprocess & MSDD_CASE_STALL_IN) != 0)) {
00285
00286 TRACE_INFO_WP("StallIn ");
00287
00288 USBD_Halt(commandState->pipeIN);
00289 haltStatus = 1;
00290 }
00291
00292
00293 if ((commandState->postprocess & MSDD_CASE_STALL_OUT) != 0) {
00294
00295 TRACE_INFO_WP("StallOut ");
00296
00297 USBD_Halt(commandState->pipeOUT);
00298 haltStatus = 1;
00299 }
00300
00301 return haltStatus;
00302 }
00303
00304
00305
00306
00307
00308
00309 static unsigned char MSDD_ProcessCommand(MSDDriver *pMsdDriver)
00310 {
00311 unsigned char status;
00312 MSDCommandState *commandState = &(pMsdDriver->commandState);
00313 MSCbw *cbw = &(commandState->cbw);
00314 MSCsw *csw = &(commandState->csw);
00315 MSDLun *lun = &(pMsdDriver->luns[(unsigned char) cbw->bCBWLUN]);
00316 unsigned char isCommandComplete = 1;
00317
00318
00319 if (cbw->bCBWLUN > pMsdDriver->maxLun) {
00320
00321 TRACE_WARNING(
00322 "MSDD_ProcessCommand: LUN %d not exist\n\r", cbw->bCBWLUN);
00323 status = MSDD_STATUS_ERROR;
00324 } else {
00325
00326
00327 if (pMsdDriver->maxLun > 0) {
00328 TRACE_INFO_WP("LUN%d ", cbw->bCBWLUN);
00329 }
00330
00331 status = SBC_ProcessCommand(lun, commandState);
00332 }
00333
00334
00335 switch (status) {
00336 case MSDD_STATUS_PARAMETER:
00337 TRACE_WARNING(
00338 "MSDD_ProcessCommand: Unknown cmd 0x%02X\n\r",
00339 cbw->pCommand[0]);
00340
00341
00342 SBC_UpdateSenseData(&(lun->requestSenseData),
00343 SBC_SENSE_KEY_ILLEGAL_REQUEST,
00344 SBC_ASC_INVALID_FIELD_IN_CDB,
00345 0);
00346
00347
00348 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00349
00350
00351 if (((cbw->bmCBWFlags & MSD_CBW_DEVICE_TO_HOST) == 0)
00352 && (cbw->dCBWDataTransferLength > 0)) {
00353
00354
00355
00356 commandState->postprocess = MSDD_CASE_STALL_OUT;
00357 TRACE_INFO_WP("StaOUT ");
00358 } else {
00359
00360
00361
00362 commandState->postprocess = MSDD_CASE_STALL_IN;
00363 TRACE_INFO_WP("StaIN ");
00364 }
00365
00366 break;
00367
00368 case MSDD_STATUS_ERROR:
00369 TRACE_WARNING("MSD_ProcessCommand: Cmd %x fail\n\r",
00370 ((SBCCommand *)commandState->cbw.pCommand)->bOperationCode);
00371
00372
00373 SBC_UpdateSenseData(&(lun->requestSenseData),
00374 SBC_SENSE_KEY_MEDIUM_ERROR,
00375 SBC_ASC_INVALID_FIELD_IN_CDB,
00376 0);
00377
00378
00379 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00380 break;
00381
00382 case MSDD_STATUS_RW:
00383 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00384 break;
00385
00386 case MSDD_STATUS_INCOMPLETE:
00387 isCommandComplete = 0;
00388
00389 SBC_UpdateSenseData(&(lun->requestSenseData),
00390 SBC_SENSE_KEY_NO_SENSE,
00391 0,
00392 0);
00393 break;
00394
00395 case MSDD_STATUS_SUCCESS:
00396
00397 SBC_UpdateSenseData(&(lun->requestSenseData),
00398 SBC_SENSE_KEY_NO_SENSE,
00399 0,
00400 0);
00401 break;
00402 }
00403
00404
00405 if (isCommandComplete) {
00406
00407 TRACE_INFO_WP("Cplt ");
00408
00409
00410 if (commandState->length != 0) {
00411
00412 csw->dCSWDataResidue += commandState->length;
00413
00414
00415 if ((cbw->bmCBWFlags & MSD_CBW_DEVICE_TO_HOST) == 0) {
00416
00417
00418
00419 commandState->postprocess = MSDD_CASE_STALL_OUT;
00420 TRACE_INFO_WP("StaOUT ");
00421 } else {
00422
00423
00424
00425 commandState->postprocess = MSDD_CASE_STALL_IN;
00426 TRACE_INFO_WP("StaIN ");
00427 }
00428 }
00429
00430
00431 commandState->state = 0;
00432 }
00433
00434 return isCommandComplete;
00435 }
00436
00437
00438
00439
00440
00441 void MSDD_StateMachine(MSDDriver *pMsdDriver)
00442 {
00443 MSDCommandState *commandState = &(pMsdDriver->commandState);
00444 MSCbw *cbw = &(commandState->cbw);
00445 MSCsw *csw = &(commandState->csw);
00446 MSDTransfer *transfer = &(commandState->transfer);
00447 unsigned char status;
00448
00449
00450 switch (pMsdDriver->state) {
00451
00452 case MSDD_STATE_READ_CBW:
00453
00454
00455 transfer->semaphore = 0;
00456
00457 USBD_HAL_WaitReadData(commandState->pipeOUT);
00458 status = USBD_Read(commandState->pipeOUT,
00459 cbw,
00460 MSD_CBW_SIZE,
00461 (TransferCallback) MSDDriver_Callback,
00462 (void *) transfer);
00463
00464
00465 if (status == USBD_STATUS_SUCCESS) {
00466
00467
00468 pMsdDriver->state = MSDD_STATE_WAIT_CBW;
00469 }
00470
00471 break;
00472
00473
00474 case MSDD_STATE_WAIT_CBW:
00475
00476
00477
00478 if (transfer->semaphore > 0) {
00479
00480
00481 transfer->semaphore--;
00482
00483
00484 if (transfer->status == USBD_STATUS_SUCCESS) {
00485 TRACE_INFO_WP("\n\r------------------------------\n\r");
00486
00487
00488 pMsdDriver->state = MSDD_STATE_PROCESS_CBW;
00489 } else if (transfer->status == USBD_STATUS_RESET) {
00490
00491 TRACE_INFO("MSDD_StateMachine: EP reset\n\r");
00492 pMsdDriver->state = MSDD_STATE_READ_CBW;
00493 } else {
00494
00495 TRACE_WARNING(
00496 "MSDD_StateMachine: Failed to read CBW\n\r");
00497 pMsdDriver->state = MSDD_STATE_READ_CBW;
00498 }
00499 }
00500
00501 break;
00502
00503
00504 case MSDD_STATE_PROCESS_CBW:
00505
00506
00507
00508 if (commandState->state == 0) {
00509
00510
00511 csw->dCSWTag = cbw->dCBWTag;
00512
00513
00514 if ((transfer->transferred != MSD_CBW_SIZE)
00515 || (cbw->dCBWSignature != MSD_CBW_SIGNATURE)) {
00516
00517 pMsdDriver->waitResetRecovery = 1;
00518
00519
00520
00521
00522
00523 csw->bCSWStatus = MSD_CSW_COMMAND_FAILED;
00524 pMsdDriver->state = MSDD_STATE_SEND_CSW;
00525 commandState->postprocess = MSDD_CASE_STALL_IN | MSDD_CASE_STALL_OUT;
00526 } else {
00527
00528
00529 MSDD_PreProcessCommand(pMsdDriver);
00530 }
00531 }
00532
00533
00534 if (csw->bCSWStatus == MSD_CSW_COMMAND_PASSED) {
00535
00536 if (MSDD_ProcessCommand(pMsdDriver)) {
00537
00538
00539 if (MSDD_PostProcessCommand(pMsdDriver)) {
00540
00541 TRACE_INFO_WP("WaitHALT ");
00542 pMsdDriver->state = MSDD_STATE_WAIT_HALT;
00543 } else
00544
00545 pMsdDriver->state = MSDD_STATE_SEND_CSW;
00546 }
00547
00548 TRACE_INFO_WP("\n\r");
00549 } else {
00550
00551 if (MSDD_PostProcessCommand(pMsdDriver)) {
00552
00553 TRACE_INFO_WP("WaitHALT ");
00554 pMsdDriver->state = MSDD_STATE_WAIT_HALT;
00555 } else
00556
00557 pMsdDriver->state = MSDD_STATE_SEND_CSW;
00558
00559 TRACE_INFO_WP("\n\r");
00560 }
00561
00562 break;
00563
00564
00565 case MSDD_STATE_SEND_CSW:
00566
00567
00568 csw->dCSWSignature = MSD_CSW_SIGNATURE;
00569
00570
00571 status = USBD_Write(commandState->pipeIN,
00572 csw,
00573 MSD_CSW_SIZE,
00574 (TransferCallback) MSDDriver_Callback,
00575 (void *) transfer);
00576
00577
00578 if (status == USBD_STATUS_SUCCESS) {
00579
00580 TRACE_INFO_WP("SendCSW ");
00581
00582
00583 pMsdDriver->state = MSDD_STATE_WAIT_CSW;
00584 }
00585
00586 break;
00587
00588
00589 case MSDD_STATE_WAIT_CSW:
00590
00591
00592
00593 if (transfer->semaphore > 0) {
00594
00595
00596 transfer->semaphore--;
00597
00598
00599
00600
00601
00602
00603
00604
00605
00606
00607
00608
00609
00610
00611
00612
00613
00614 pMsdDriver->state = MSDD_STATE_READ_CBW;
00615 }
00616
00617 break;
00618
00619
00620 case MSDD_STATE_WAIT_HALT:
00621
00622
00623
00624 if (!USBD_IsHalted(commandState->pipeIN))
00625
00626 pMsdDriver->state = MSDD_STATE_SEND_CSW;
00627
00628 break;
00629 }
00630 }
00631
00632