#define INCLUDE_FROM_SI_CLASS_HOST_C\r
#include "StillImage.h"\r
\r
-#warning The Still Image Host mode Class driver is currently incomplete and is for preview purposes only.\r
-\r
uint8_t SI_Host_ConfigurePipes(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, uint16_t ConfigDescriptorLength,\r
uint8_t* DeviceConfigDescriptor)\r
{\r
}\r
}\r
\r
+ SIInterfaceInfo->State.IsActive = true;\r
return SI_ENUMERROR_NoError;\r
}\r
\r
{\r
if (DESCRIPTOR_TYPE(CurrentDescriptor) == DTYPE_Interface)\r
{\r
- if ((DESCRIPTOR_CAST(CurrentDescriptor, USB_Descriptor_Interface_t).Class == STILL_IMAGE_CLASS) &&\r
- (DESCRIPTOR_CAST(CurrentDescriptor, USB_Descriptor_Interface_t).SubClass == STILL_IMAGE_SUBCLASS) &&\r
- (DESCRIPTOR_CAST(CurrentDescriptor, USB_Descriptor_Interface_t).Protocol == STILL_IMAGE_PROTOCOL))\r
+ USB_Descriptor_Interface_t* CurrentInterface = DESCRIPTOR_PCAST(CurrentDescriptor,\r
+ USB_Descriptor_Interface_t);\r
+\r
+ if ((CurrentInterface->Class == STILL_IMAGE_CLASS) &&\r
+ (CurrentInterface->SubClass == STILL_IMAGE_SUBCLASS) &&\r
+ (CurrentInterface->Protocol == STILL_IMAGE_PROTOCOL))\r
{\r
return DESCRIPTOR_SEARCH_Found;\r
}\r
\r
}\r
\r
+static uint8_t SImage_Host_SendBlockHeader(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, SI_PIMA_Container_t* PIMAHeader)\r
+{\r
+ uint8_t ErrorCode;\r
+ \r
+ PIMAHeader->TransactionID = SIInterfaceInfo->State.TransactionID++;\r
+\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.DataOUTPipeNumber);\r
+ Pipe_Unfreeze();\r
+\r
+ if ((ErrorCode = Pipe_Write_Stream_LE(PIMAHeader, PIMA_COMMAND_SIZE(0), NO_STREAM_CALLBACK)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+ \r
+ uint8_t ParamBytes = (PIMAHeader->DataLength - PIMA_COMMAND_SIZE(0));\r
+\r
+ if (ParamBytes)\r
+ {\r
+ if ((ErrorCode = Pipe_Write_Stream_LE(&PIMAHeader->Params, ParamBytes, NO_STREAM_CALLBACK)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+ }\r
+ \r
+ Pipe_ClearOUT(); \r
+ Pipe_Freeze();\r
+ \r
+ return PIPE_RWSTREAM_NoError;\r
+}\r
+\r
+static uint8_t SImage_Host_ReceiveBlockHeader(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, SI_PIMA_Container_t* PIMAHeader)\r
+{\r
+ uint16_t TimeoutMSRem = COMMAND_DATA_TIMEOUT_MS;\r
+\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.DataINPipeNumber);\r
+ Pipe_Unfreeze();\r
+ \r
+ while (!(Pipe_IsReadWriteAllowed()))\r
+ {\r
+ if (USB_INT_HasOccurred(USB_INT_HSOFI))\r
+ {\r
+ USB_INT_Clear(USB_INT_HSOFI);\r
+ TimeoutMSRem--;\r
+\r
+ if (!(TimeoutMSRem))\r
+ {\r
+ return PIPE_RWSTREAM_Timeout;\r
+ }\r
+ }\r
+ \r
+ Pipe_Freeze();\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.DataOUTPipeNumber);\r
+ Pipe_Unfreeze();\r
+\r
+ if (Pipe_IsStalled())\r
+ {\r
+ USB_Host_ClearPipeStall(SIInterfaceInfo->Config.DataOUTPipeNumber);\r
+ return PIPE_RWSTREAM_PipeStalled;\r
+ }\r
+\r
+ Pipe_Freeze();\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.DataINPipeNumber);\r
+ Pipe_Unfreeze();\r
+\r
+ if (Pipe_IsStalled())\r
+ {\r
+ USB_Host_ClearPipeStall(SIInterfaceInfo->Config.DataINPipeNumber);\r
+ return PIPE_RWSTREAM_PipeStalled;\r
+ }\r
+ \r
+ if (USB_HostState == HOST_STATE_Unattached)\r
+ return PIPE_RWSTREAM_DeviceDisconnected;\r
+ }\r
+ \r
+ Pipe_Read_Stream_LE(PIMAHeader, PIMA_COMMAND_SIZE(0), NO_STREAM_CALLBACK);\r
+ \r
+ if (PIMAHeader->Type == CType_ResponseBlock)\r
+ {\r
+ uint8_t ParamBytes = (PIMAHeader->DataLength - PIMA_COMMAND_SIZE(0));\r
+\r
+ if (ParamBytes)\r
+ Pipe_Read_Stream_LE(&PIMAHeader->Params, ParamBytes, NO_STREAM_CALLBACK);\r
+ \r
+ Pipe_ClearIN();\r
+ \r
+ PIMAHeader->Code &= 0x0000000F;\r
+ }\r
+ \r
+ Pipe_Freeze();\r
+ \r
+ return PIPE_RWSTREAM_NoError;\r
+}\r
+\r
+uint8_t SImage_Host_SendData(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, void* Buffer, uint16_t Bytes)\r
+{\r
+ uint8_t ErrorCode;\r
+\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.DataOUTPipeNumber);\r
+ Pipe_Unfreeze();\r
+ \r
+ ErrorCode = Pipe_Write_Stream_LE(Buffer, Bytes, NO_STREAM_CALLBACK);\r
+\r
+ Pipe_ClearOUT();\r
+ Pipe_Freeze();\r
+ \r
+ return ErrorCode;\r
+}\r
+\r
+uint8_t SImage_Host_ReadData(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, void* Buffer, uint16_t Bytes)\r
+{\r
+ uint8_t ErrorCode;\r
+\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.DataINPipeNumber);\r
+ Pipe_Unfreeze();\r
+\r
+ ErrorCode = Pipe_Read_Stream_LE(Buffer, Bytes, NO_STREAM_CALLBACK);\r
+\r
+ Pipe_Freeze();\r
+ \r
+ return ErrorCode;\r
+}\r
+\r
+bool SImage_Host_IsEventReceived(USB_ClassInfo_SI_Host_t* SIInterfaceInfo)\r
+{\r
+ bool IsEventReceived = false;\r
+\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.EventsPipeNumber);\r
+ Pipe_Unfreeze();\r
+ \r
+ if (Pipe_BytesInPipe())\r
+ IsEventReceived = true;\r
+ \r
+ Pipe_Freeze();\r
+ \r
+ return IsEventReceived;\r
+}\r
+\r
+uint8_t SImage_Host_ReceiveEventHeader(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, SI_PIMA_Container_t* PIMAHeader)\r
+{\r
+ uint8_t ErrorCode;\r
+\r
+ Pipe_SelectPipe(SIInterfaceInfo->Config.EventsPipeNumber);\r
+ Pipe_Unfreeze();\r
+ \r
+ ErrorCode = Pipe_Read_Stream_LE(PIMAHeader, sizeof(SI_PIMA_Container_t), NO_STREAM_CALLBACK);\r
+ \r
+ Pipe_ClearIN();\r
+ Pipe_Freeze();\r
+ \r
+ return ErrorCode;\r
+}\r
+\r
+uint8_t SImage_Host_OpenSession(USB_ClassInfo_SI_Host_t* SIInterfaceInfo)\r
+{\r
+ if ((USB_HostState != HOST_STATE_Configured) || !(SIInterfaceInfo->State.IsActive))\r
+ return HOST_SENDCONTROL_DeviceDisconnect;\r
+\r
+ uint8_t ErrorCode;\r
+\r
+ SI_PIMA_Container_t PIMABlock = (SI_PIMA_Container_t)\r
+ {\r
+ .DataLength = PIMA_COMMAND_SIZE(0),\r
+ .Type = CType_CommandBlock,\r
+ .Code = 0x1002,\r
+ .Params = {},\r
+ };\r
+ \r
+ if ((ErrorCode = SImage_Host_SendBlockHeader(SIInterfaceInfo, &PIMABlock)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+ \r
+ if ((ErrorCode = SImage_Host_ReceiveBlockHeader(SIInterfaceInfo, &PIMABlock)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+ \r
+ if ((PIMABlock.Type != CType_ResponseBlock) || (PIMABlock.Code != 0x2001))\r
+ return SI_ERROR_LOGICAL_CMD_FAILED;\r
+ \r
+ SIInterfaceInfo->State.TransactionID = 0;\r
+ SIInterfaceInfo->State.IsSessionOpen = true;\r
+\r
+ return PIPE_RWSTREAM_NoError;\r
+}\r
+\r
+uint8_t SImage_Host_CloseSession(USB_ClassInfo_SI_Host_t* SIInterfaceInfo)\r
+{\r
+ if ((USB_HostState != HOST_STATE_Configured) || !(SIInterfaceInfo->State.IsActive))\r
+ return HOST_SENDCONTROL_DeviceDisconnect;\r
+\r
+ uint8_t ErrorCode;\r
+\r
+ SI_PIMA_Container_t PIMABlock = (SI_PIMA_Container_t)\r
+ {\r
+ .DataLength = PIMA_COMMAND_SIZE(0),\r
+ .Type = CType_CommandBlock,\r
+ .Code = 0x1003,\r
+ .Params = {},\r
+ };\r
+ \r
+ if ((ErrorCode = SImage_Host_SendBlockHeader(SIInterfaceInfo, &PIMABlock)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+ \r
+ if ((ErrorCode = SImage_Host_ReceiveBlockHeader(SIInterfaceInfo, &PIMABlock)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+\r
+ SIInterfaceInfo->State.IsSessionOpen = false;\r
+\r
+ if ((PIMABlock.Type != CType_ResponseBlock) || (PIMABlock.Code != 0x2001))\r
+ return SI_ERROR_LOGICAL_CMD_FAILED;\r
+\r
+ return PIPE_RWSTREAM_NoError;\r
+}\r
+\r
+uint8_t SImage_Host_SendCommand(USB_ClassInfo_SI_Host_t* SIInterfaceInfo, uint16_t Operation,\r
+ uint8_t TotalParams, uint32_t* Params)\r
+{\r
+ if ((USB_HostState != HOST_STATE_Configured) || !(SIInterfaceInfo->State.IsActive))\r
+ return HOST_SENDCONTROL_DeviceDisconnect;\r
+\r
+ uint8_t ErrorCode;\r
+\r
+ SI_PIMA_Container_t PIMABlock = (SI_PIMA_Container_t)\r
+ {\r
+ .DataLength = PIMA_COMMAND_SIZE(TotalParams),\r
+ .Type = CType_CommandBlock,\r
+ .Code = Operation,\r
+ };\r
+ \r
+ memcpy(&PIMABlock.Params, Params, sizeof(uint32_t) * TotalParams);\r
+ \r
+ if ((ErrorCode = SImage_Host_SendBlockHeader(SIInterfaceInfo, &PIMABlock)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+\r
+ return PIPE_RWSTREAM_NoError;\r
+}\r
+\r
+uint8_t SImage_Host_ReceiveResponse(USB_ClassInfo_SI_Host_t* SIInterfaceInfo)\r
+{\r
+ uint8_t ErrorCode;\r
+ SI_PIMA_Container_t PIMABlock;\r
+\r
+ if ((ErrorCode = SImage_Host_ReceiveBlockHeader(SIInterfaceInfo, &PIMABlock)) != PIPE_RWSTREAM_NoError)\r
+ return ErrorCode;\r
+\r
+ if ((PIMABlock.Type != CType_ResponseBlock) || (PIMABlock.Code != 0x2001))\r
+ return SI_ERROR_LOGICAL_CMD_FAILED;\r
+ \r
+ return PIPE_RWSTREAM_NoError;\r
+}\r
+\r
#endif\r
projects / pub / USBasp.git / blobdiff