|
|
|
@ -34,7 +34,7 @@ |
|
|
|
|
#define INCLUDE_FROM_MS_CLASS_DEVICE_C |
|
|
|
|
#include "MassStorage.h" |
|
|
|
|
|
|
|
|
|
static USB_ClassInfo_MS_Device_t* CallbackMSInterfaceInfo; |
|
|
|
|
static volatile bool* CallbackIsResetSource; |
|
|
|
|
|
|
|
|
|
void MS_Device_ProcessControlRequest(USB_ClassInfo_MS_Device_t* const MSInterfaceInfo) |
|
|
|
|
{ |
|
|
|
@ -130,8 +130,10 @@ void MS_Device_USBTask(USB_ClassInfo_MS_Device_t* const MSInterfaceInfo) |
|
|
|
|
|
|
|
|
|
Endpoint_SelectEndpoint(MSInterfaceInfo->Config.DataOUTEndpointNumber); |
|
|
|
|
Endpoint_ClearStall(); |
|
|
|
|
Endpoint_ResetDataToggle(); |
|
|
|
|
Endpoint_SelectEndpoint(MSInterfaceInfo->Config.DataINEndpointNumber); |
|
|
|
|
Endpoint_ClearStall(); |
|
|
|
|
Endpoint_ResetDataToggle(); |
|
|
|
|
|
|
|
|
|
MSInterfaceInfo->State.IsMassStoreReset = false; |
|
|
|
|
} |
|
|
|
@ -141,10 +143,13 @@ static bool MS_Device_ReadInCommandBlock(USB_ClassInfo_MS_Device_t* const MSInte |
|
|
|
|
{ |
|
|
|
|
Endpoint_SelectEndpoint(MSInterfaceInfo->Config.DataOUTEndpointNumber); |
|
|
|
|
|
|
|
|
|
CallbackMSInterfaceInfo = MSInterfaceInfo; |
|
|
|
|
Endpoint_Read_Stream_LE(&MSInterfaceInfo->State.CommandBlock, |
|
|
|
|
CallbackIsResetSource = &MSInterfaceInfo->State.IsMassStoreReset; |
|
|
|
|
if (Endpoint_Read_Stream_LE(&MSInterfaceInfo->State.CommandBlock, |
|
|
|
|
(sizeof(MS_CommandBlockWrapper_t) - 16), |
|
|
|
|
StreamCallback_MS_Device_AbortOnMassStoreReset); |
|
|
|
|
StreamCallback_MS_Device_AbortOnMassStoreReset)) |
|
|
|
|
{ |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if ((MSInterfaceInfo->State.CommandBlock.Signature != MS_CBW_SIGNATURE) || |
|
|
|
|
(MSInterfaceInfo->State.CommandBlock.LUN >= MSInterfaceInfo->Config.TotalLUNs) || |
|
|
|
@ -159,14 +164,17 @@ static bool MS_Device_ReadInCommandBlock(USB_ClassInfo_MS_Device_t* const MSInte |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
CallbackMSInterfaceInfo = MSInterfaceInfo; |
|
|
|
|
Endpoint_Read_Stream_LE(&MSInterfaceInfo->State.CommandBlock.SCSICommandData, |
|
|
|
|
CallbackIsResetSource = &MSInterfaceInfo->State.IsMassStoreReset; |
|
|
|
|
if (Endpoint_Read_Stream_LE(&MSInterfaceInfo->State.CommandBlock.SCSICommandData, |
|
|
|
|
MSInterfaceInfo->State.CommandBlock.SCSICommandLength, |
|
|
|
|
StreamCallback_MS_Device_AbortOnMassStoreReset); |
|
|
|
|
StreamCallback_MS_Device_AbortOnMassStoreReset)) |
|
|
|
|
{ |
|
|
|
|
return false; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
Endpoint_ClearOUT(); |
|
|
|
|
|
|
|
|
|
return !(MSInterfaceInfo->State.IsMassStoreReset); |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static void MS_Device_ReturnCommandStatus(USB_ClassInfo_MS_Device_t* const MSInterfaceInfo) |
|
|
|
@ -175,7 +183,9 @@ static void MS_Device_ReturnCommandStatus(USB_ClassInfo_MS_Device_t* const MSInt |
|
|
|
|
|
|
|
|
|
while (Endpoint_IsStalled()) |
|
|
|
|
{ |
|
|
|
|
#if !defined(INTERRUPT_CONTROL_ENDPOINT) |
|
|
|
|
USB_USBTask(); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
if (MSInterfaceInfo->State.IsMassStoreReset) |
|
|
|
|
return; |
|
|
|
@ -185,27 +195,31 @@ static void MS_Device_ReturnCommandStatus(USB_ClassInfo_MS_Device_t* const MSInt |
|
|
|
|
|
|
|
|
|
while (Endpoint_IsStalled()) |
|
|
|
|
{ |
|
|
|
|
#if !defined(INTERRUPT_CONTROL_ENDPOINT) |
|
|
|
|
USB_USBTask(); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
if (MSInterfaceInfo->State.IsMassStoreReset) |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
CallbackMSInterfaceInfo = MSInterfaceInfo; |
|
|
|
|
Endpoint_Write_Stream_LE(&MSInterfaceInfo->State.CommandStatus, sizeof(MS_CommandStatusWrapper_t), |
|
|
|
|
StreamCallback_MS_Device_AbortOnMassStoreReset); |
|
|
|
|
CallbackIsResetSource = &MSInterfaceInfo->State.IsMassStoreReset; |
|
|
|
|
if (Endpoint_Write_Stream_LE(&MSInterfaceInfo->State.CommandStatus, sizeof(MS_CommandStatusWrapper_t), |
|
|
|
|
StreamCallback_MS_Device_AbortOnMassStoreReset)) |
|
|
|
|
{ |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
Endpoint_ClearIN(); |
|
|
|
|
|
|
|
|
|
if (MSInterfaceInfo->State.IsMassStoreReset) |
|
|
|
|
return; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static uint8_t StreamCallback_MS_Device_AbortOnMassStoreReset(void) |
|
|
|
|
{ |
|
|
|
|
MS_Device_USBTask(CallbackMSInterfaceInfo); |
|
|
|
|
#if !defined(INTERRUPT_CONTROL_ENDPOINT) |
|
|
|
|
USB_USBTask(); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
if (CallbackMSInterfaceInfo->State.IsMassStoreReset) |
|
|
|
|
if (*CallbackIsResetSource) |
|
|
|
|
return STREAMCALLBACK_Abort; |
|
|
|
|
else |
|
|
|
|
return STREAMCALLBACK_Continue; |
|
|
|
|