return MS_ENUMERROR_InvalidConfigDescriptor;\r
\r
if (USB_GetNextDescriptorComp(&ConfigDescriptorLength, &DeviceConfigDescriptor,\r
- DComp_NextMassStorageInterface) != DESCRIPTOR_SEARCH_COMP_Found)\r
+ DComp_NextMSInterface) != DESCRIPTOR_SEARCH_COMP_Found)\r
{\r
return MS_ENUMERROR_NoMSInterfaceFound;\r
}\r
while (FoundEndpoints != (MS_FOUND_DATAPIPE_IN | MS_FOUND_DATAPIPE_OUT))\r
{\r
if (USB_GetNextDescriptorComp(&ConfigDescriptorLength, &DeviceConfigDescriptor,\r
- DComp_NextInterfaceBulkDataEndpoint) != DESCRIPTOR_SEARCH_COMP_Found)\r
+ DComp_NextMSInterfaceEndpoint) != DESCRIPTOR_SEARCH_COMP_Found)\r
{\r
return MS_ENUMERROR_EndpointsNotFound;\r
}\r
return MS_ENUMERROR_NoError;\r
}\r
\r
-static uint8_t DComp_NextMassStorageInterface(void* CurrentDescriptor)\r
+static uint8_t DComp_NextMSInterface(void* CurrentDescriptor)\r
{\r
if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Interface)\r
{\r
return DESCRIPTOR_SEARCH_NotFound;\r
}\r
\r
-static uint8_t DComp_NextInterfaceBulkDataEndpoint(void* CurrentDescriptor)\r
+static uint8_t DComp_NextMSInterfaceEndpoint(void* CurrentDescriptor)\r
{\r
if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Endpoint)\r
{\r
- uint8_t EndpointType = (DESCRIPTOR_CAST(CurrentDescriptor,\r
- USB_Descriptor_Endpoint_t).Attributes & EP_TYPE_MASK);\r
+ USB_Descriptor_Endpoint_t* CurrentEndpoint = DESCRIPTOR_PCAST(CurrentDescriptor,\r
+ USB_Descriptor_Endpoint_t);\r
\r
- if (EndpointType == EP_TYPE_BULK)\r
- return DESCRIPTOR_SEARCH_Found;\r
+ uint8_t EndpointType = (CurrentEndpoint->Attributes & EP_TYPE_MASK);\r
+\r
+ if ((EndpointType == EP_TYPE_BULK) &&\r
+ (!(Pipe_IsEndpointBound(CurrentEndpoint->EndpointAddress))))\r
+ {\r
+ return DESCRIPTOR_SEARCH_Found;\r
+ }\r
}\r
else if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Interface)\r
{\r
\r
}\r
\r
-static uint8_t MS_Host_SendCommand(USB_ClassInfo_MS_Host_t* MSInterfaceInfo, MS_CommandBlockWrapper_t* SCSICommandBlock)\r
+static uint8_t MS_Host_SendCommand(USB_ClassInfo_MS_Host_t* MSInterfaceInfo, MS_CommandBlockWrapper_t* SCSICommandBlock,\r
+ void* BufferPtr)\r
{\r
uint8_t ErrorCode = PIPE_RWSTREAM_NoError;\r
\r
- if (++MSInterfaceInfo->State.TransactionTag == 0xFFFFFFFF)\r
+ SCSICommandBlock->Tag = ++MSInterfaceInfo->State.TransactionTag;\r
+\r
+ if (MSInterfaceInfo->State.TransactionTag == 0xFFFFFFFF)\r
MSInterfaceInfo->State.TransactionTag = 1;\r
\r
Pipe_SelectPipe(MSInterfaceInfo->Config.DataOUTPipeNumber);\r
return ErrorCode;\r
\r
Pipe_ClearOUT();\r
- while(!(Pipe_IsOUTReady()));\r
+ Pipe_WaitUntilReady();\r
\r
Pipe_Freeze();\r
+\r
+ if ((BufferPtr != NULL) &&\r
+ ((ErrorCode = MS_Host_SendReceiveData(MSInterfaceInfo, SCSICommandBlock, BufferPtr)) != PIPE_RWSTREAM_NoError))\r
+ {\r
+ Pipe_Freeze();\r
+ return ErrorCode;\r
+ }\r
\r
- return PIPE_RWSTREAM_NoError;\r
+ return ErrorCode;\r
}\r
\r
static uint8_t MS_Host_WaitForDataReceived(USB_ClassInfo_MS_Host_t* MSInterfaceInfo)\r
}\r
\r
static uint8_t MS_Host_SendReceiveData(USB_ClassInfo_MS_Host_t* MSInterfaceInfo,\r
- MS_CommandBlockWrapper_t* SCSICommandBlock, void* BufferPtr)\r
+ MS_CommandBlockWrapper_t* SCSICommandBlock, void* BufferPtr)\r
{\r
uint8_t ErrorCode = PIPE_RWSTREAM_NoError;\r
uint16_t BytesRem = SCSICommandBlock->DataTransferLength;\r
\r
if (SCSICommandBlock->Flags & COMMAND_DIRECTION_DATA_IN)\r
{\r
+ if ((ErrorCode = MS_Host_WaitForDataReceived(MSInterfaceInfo)) != PIPE_RWSTREAM_NoError)\r
+ {\r
+ Pipe_Freeze();\r
+ return ErrorCode;\r
+ }\r
+\r
Pipe_SelectPipe(MSInterfaceInfo->Config.DataINPipeNumber);\r
Pipe_Unfreeze();\r
\r
\r
Pipe_Freeze();\r
\r
- return PIPE_RWSTREAM_NoError;\r
+ return ErrorCode;\r
}\r
\r
static uint8_t MS_Host_GetReturnedStatus(USB_ClassInfo_MS_Host_t* MSInterfaceInfo,\r
- MS_CommandStatusWrapper_t* SCSICommandStatus)\r
+ MS_CommandStatusWrapper_t* SCSICommandStatus)\r
{\r
uint8_t ErrorCode = PIPE_RWSTREAM_NoError;\r
\r
Pipe_SelectPipe(MSInterfaceInfo->Config.DataINPipeNumber);\r
Pipe_Unfreeze();\r
\r
- if ((ErrorCode = Pipe_Read_Stream_LE(&SCSICommandStatus, sizeof(MS_CommandStatusWrapper_t))) != PIPE_RWSTREAM_NoError)\r
+ if ((ErrorCode = Pipe_Read_Stream_LE(SCSICommandStatus, sizeof(MS_CommandStatusWrapper_t))) != PIPE_RWSTREAM_NoError)\r
return ErrorCode;\r
\r
Pipe_ClearIN();\r
Pipe_Freeze();\r
\r
- return PIPE_RWSTREAM_NoError;\r
+ if (SCSICommandStatus->Status != SCSI_Command_Pass)\r
+ ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
+ \r
+ return ErrorCode;\r
}\r
\r
uint8_t MS_Host_ResetMSInterface(USB_ClassInfo_MS_Host_t* MSInterfaceInfo)\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = sizeof(SCSI_Inquiry_Response_t),\r
.Flags = COMMAND_DIRECTION_DATA_IN,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
+\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, InquiryData)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode; \r
}\r
\r
- if ((ErrorCode = MS_Host_WaitForDataReceived(MSInterfaceInfo)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
-\r
- if ((ErrorCode = MS_Host_SendReceiveData(MSInterfaceInfo, &SCSICommandBlock, InquiryData)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- } \r
- \r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = 0,\r
.Flags = COMMAND_DIRECTION_DATA_IN,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
+\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, NULL)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode; \r
}\r
\r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = sizeof(SCSI_Capacity_t),\r
.Flags = COMMAND_DIRECTION_DATA_IN,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
\r
- if ((ErrorCode = MS_Host_WaitForDataReceived(MSInterfaceInfo)) != PIPE_RWSTREAM_NoError)\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, DeviceCapacity)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
\r
- if ((ErrorCode = MS_Host_SendReceiveData(MSInterfaceInfo, &SCSICommandBlock, DeviceCapacity)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
- \r
DeviceCapacity->Blocks = SwapEndian_32(DeviceCapacity->Blocks);\r
DeviceCapacity->BlockSize = SwapEndian_32(DeviceCapacity->BlockSize);\r
\r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = sizeof(SCSI_Request_Sense_Response_t),\r
.Flags = COMMAND_DIRECTION_DATA_IN,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
- \r
- if ((ErrorCode = MS_Host_WaitForDataReceived(MSInterfaceInfo)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
\r
- if ((ErrorCode = MS_Host_SendReceiveData(MSInterfaceInfo, &SCSICommandBlock, SenseData)) != PIPE_RWSTREAM_NoError)\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, SenseData)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
+\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = 0,\r
.Flags = COMMAND_DIRECTION_DATA_OUT,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
+\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, NULL)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
\r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = ((uint32_t)Blocks * BlockSize),\r
.Flags = COMMAND_DIRECTION_DATA_IN,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
- \r
- if ((ErrorCode = MS_Host_WaitForDataReceived(MSInterfaceInfo)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
\r
- if ((ErrorCode = MS_Host_SendReceiveData(MSInterfaceInfo, &SCSICommandBlock, BlockBuffer)) != PIPE_RWSTREAM_NoError)\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, BlockBuffer)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
+\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r
MS_CommandBlockWrapper_t SCSICommandBlock = (MS_CommandBlockWrapper_t)\r
{\r
.Signature = CBW_SIGNATURE,\r
- .Tag = MSInterfaceInfo->State.TransactionTag,\r
.DataTransferLength = ((uint32_t)Blocks * BlockSize),\r
.Flags = COMMAND_DIRECTION_DATA_OUT,\r
.LUN = LUNIndex,\r
}\r
};\r
\r
- if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock)) != PIPE_RWSTREAM_NoError)\r
- {\r
- Pipe_Freeze();\r
- return ErrorCode;\r
- }\r
+ MS_CommandStatusWrapper_t SCSICommandStatus;\r
\r
- if ((ErrorCode = MS_Host_SendReceiveData(MSInterfaceInfo, &SCSICommandBlock, BlockBuffer)) != PIPE_RWSTREAM_NoError)\r
+ if ((ErrorCode = MS_Host_SendCommand(MSInterfaceInfo, &SCSICommandBlock, BlockBuffer)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
\r
- MS_CommandStatusWrapper_t SCSICommandStatus;\r
if ((ErrorCode = MS_Host_GetReturnedStatus(MSInterfaceInfo, &SCSICommandStatus)) != PIPE_RWSTREAM_NoError)\r
{\r
Pipe_Freeze();\r
return ErrorCode;\r
}\r
- \r
- if (SCSICommandStatus.Status != SCSI_Command_Pass)\r
- ErrorCode = MS_ERROR_LOGICAL_CMD_FAILED;\r
\r
return ErrorCode;\r
}\r