-void EVENT_USB_DeviceEnumerationFailed(const uint8_t ErrorCode, const uint8_t SubErrorCode)\r
-{\r
- puts_P(PSTR(ESC_BG_RED "Dev Enum Error\r\n"));\r
- printf_P(PSTR(" -- Error Code %d\r\n"), ErrorCode);\r
- printf_P(PSTR(" -- Sub Error Code %d\r\n"), SubErrorCode);\r
- printf_P(PSTR(" -- In State %d\r\n"), USB_HostState);\r
- \r
- UpdateStatus(Status_EnumerationError);\r
-}\r
-\r
-/** Task to set the configuration of the attached device after it has been enumerated, and to print device information\r
- * through the serial port.\r
- */\r
-TASK(USB_SImage_Host)\r
-{\r
- uint8_t ErrorCode;\r
-\r
- switch (USB_HostState)\r
- {\r
- case HOST_STATE_Addressed:\r
- /* Standard request to set the device configuration to configuration 1 */\r
- USB_ControlRequest = (USB_Request_Header_t)\r
- {\r
- .bmRequestType = (REQDIR_HOSTTODEVICE | REQTYPE_STANDARD | REQREC_DEVICE),\r
- .bRequest = REQ_SetConfiguration,\r
- .wValue = 1,\r
- .wIndex = 0,\r
- .wLength = 0,\r
- };\r
-\r
- /* Select the control pipe for the request transfer */\r
- Pipe_SelectPipe(PIPE_CONTROLPIPE);\r
-\r
- /* Send the request, display error and wait for device detach if request fails */\r
- if (USB_Host_SendControlRequest(NULL) != HOST_SENDCONTROL_Successful)\r
- {\r
- puts_P(PSTR("Control error.\r\n"));\r
-\r
- /* Indicate error via status LEDs */\r
- UpdateStatus(Status_EnumerationError);\r
-\r
- /* Wait until USB device disconnected */\r
- while (USB_IsConnected);\r
- break;\r
- }\r
- \r
- USB_HostState = HOST_STATE_Configured;\r
- break;\r
- case HOST_STATE_Configured:\r
- puts_P(PSTR("Getting Config Data.\r\n"));\r
- \r
- /* Get and process the configuration descriptor data */\r
- if ((ErrorCode = ProcessConfigurationDescriptor()) != SuccessfulConfigRead)\r
- {\r
- if (ErrorCode == ControlError)\r
- puts_P(PSTR("Control Error (Get Configuration).\r\n"));\r
- else\r
- puts_P(PSTR("Invalid Device.\r\n"));\r
-\r
- printf_P(PSTR(" -- Error Code: %d\r\n"), ErrorCode);\r
- \r
- /* Indicate error via status LEDs */\r
- UpdateStatus(Status_EnumerationError);\r
-\r
- /* Wait until USB device disconnected */\r
- while (USB_IsConnected);\r
- break;\r
- }\r
-\r
- puts_P(PSTR("Still Image Device Enumerated.\r\n"));\r
- \r
- USB_HostState = HOST_STATE_Ready;\r
- break;\r
- case HOST_STATE_Ready:\r
- /* Indicate device busy via the status LEDs */\r
- UpdateStatus(Status_Busy);\r
-\r
- puts_P(PSTR("Retrieving Device Info...\r\n"));\r
- \r
- PIMA_SendBlock = (PIMA_Container_t)\r
- {\r
- .DataLength = PIMA_COMMAND_SIZE(0),\r
- .Type = CType_CommandBlock,\r
- .Code = PIMA_OPERATION_GETDEVICEINFO,\r
- .TransactionID = 0x00000000,\r
- .Params = {},\r
- };\r
- \r
- /* Send the GETDEVICEINFO block */\r
- SImage_SendBlockHeader();\r
- \r
- /* Receive the response data block */\r
- if ((ErrorCode = SImage_RecieveBlockHeader()) != PIPE_RWSTREAM_NoError)\r
- {\r
- ShowCommandError(ErrorCode, false);\r
- break;\r
- }\r
- \r
- /* Calculate the size of the returned device info data structure */\r
- uint16_t DeviceInfoSize = (PIMA_ReceivedBlock.DataLength - PIMA_COMMAND_SIZE(0));\r
- \r
- /* Create a buffer large enough to hold the entire device info */\r
- uint8_t DeviceInfo[DeviceInfoSize];\r
-\r
- /* Read in the data block data (containing device info) */\r
- SImage_ReadData(DeviceInfo, DeviceInfoSize);\r
- \r
- /* Once all the data has been read, the pipe must be cleared before the response can be sent */\r
- Pipe_ClearIN();\r
- \r
- /* Create a pointer for walking through the info dataset */\r
- uint8_t* DeviceInfoPos = DeviceInfo;\r
- \r
- /* Skip over the data before the unicode device information strings */\r
- DeviceInfoPos += 8; // Skip to VendorExtensionDesc String\r
- DeviceInfoPos += ((*DeviceInfoPos << 1) + 1); // Skip over VendorExtensionDesc String\r
- DeviceInfoPos += 2; // Skip over FunctionalMode\r
- DeviceInfoPos += (4 + (*(uint32_t*)DeviceInfoPos << 1)); // Skip over OperationCode Array\r
- DeviceInfoPos += (4 + (*(uint32_t*)DeviceInfoPos << 1)); // Skip over EventCode Array\r
- DeviceInfoPos += (4 + (*(uint32_t*)DeviceInfoPos << 1)); // Skip over DevicePropCode Array\r
- DeviceInfoPos += (4 + (*(uint32_t*)DeviceInfoPos << 1)); // Skip over ObjectFormatCode Array\r
- DeviceInfoPos += (4 + (*(uint32_t*)DeviceInfoPos << 1)); // Skip over ObjectFormatCode Array\r
- \r
- /* Extract and convert the Manufacturer Unicode string to ASCII and print it through the USART */\r
- char Manufacturer[*DeviceInfoPos];\r
- UnicodeToASCII(DeviceInfoPos, Manufacturer);\r
- printf_P(PSTR(" Manufacturer: %s\r\n"), Manufacturer);\r
-\r
- DeviceInfoPos += ((*DeviceInfoPos << 1) + 1); // Skip over Manufacturer String\r
-\r
- /* Extract and convert the Model Unicode string to ASCII and print it through the USART */\r
- char Model[*DeviceInfoPos];\r
- UnicodeToASCII(DeviceInfoPos, Model);\r
- printf_P(PSTR(" Model: %s\r\n"), Model);\r
-\r
- DeviceInfoPos += ((*DeviceInfoPos << 1) + 1); // Skip over Model String\r
-\r
- /* Extract and convert the Device Version Unicode string to ASCII and print it through the USART */\r
- char DeviceVersion[*DeviceInfoPos];\r
- UnicodeToASCII(DeviceInfoPos, DeviceVersion);\r
- printf_P(PSTR(" Device Version: %s\r\n"), DeviceVersion);\r
-\r
- /* Receive the final response block from the device */\r
- if ((ErrorCode = SImage_RecieveBlockHeader()) != PIPE_RWSTREAM_NoError)\r
- {\r
- ShowCommandError(ErrorCode, false);\r
- break;\r
- }\r
- \r
- /* Verify that the command completed successfully */\r
- if ((PIMA_ReceivedBlock.Type != CType_ResponseBlock) || (PIMA_ReceivedBlock.Code != PIMA_RESPONSE_OK))\r
- {\r
- ShowCommandError(PIMA_ReceivedBlock.Code, true);\r
- break;\r
- }\r
- \r
- puts_P(PSTR("Opening Session...\r\n"));\r
- \r
- PIMA_SendBlock = (PIMA_Container_t)\r
- {\r
- .DataLength = PIMA_COMMAND_SIZE(1),\r
- .Type = CType_CommandBlock,\r
- .Code = PIMA_OPERATION_OPENSESSION,\r
- .TransactionID = 0x00000000,\r
- .Params = {0x00000001},\r
- };\r
- \r
- /* Send the OPENSESSION block, open a session with an ID of 0x0001 */\r
- SImage_SendBlockHeader();\r
- \r
- /* Receive the response block from the device */\r
- if ((ErrorCode = SImage_RecieveBlockHeader()) != PIPE_RWSTREAM_NoError)\r
- {\r
- ShowCommandError(ErrorCode, false);\r
- break;\r
- }\r
- \r
- /* Verify that the command completed successfully */\r
- if ((PIMA_ReceivedBlock.Type != CType_ResponseBlock) || (PIMA_ReceivedBlock.Code != PIMA_RESPONSE_OK))\r
- {\r
- ShowCommandError(PIMA_ReceivedBlock.Code, true);\r
- break;\r
- }\r
-\r
- puts_P(PSTR("Closing Session...\r\n"));\r
-\r
- PIMA_SendBlock = (PIMA_Container_t)\r
- {\r
- .DataLength = PIMA_COMMAND_SIZE(1),\r
- .Type = CType_CommandBlock,\r
- .Code = PIMA_OPERATION_CLOSESESSION,\r
- .TransactionID = 0x00000001,\r
- .Params = {0x00000001},\r
- };\r
- \r
- /* Send the CLOSESESSION block, close the session with an ID of 0x0001 */\r
- SImage_SendBlockHeader();\r
- \r
- /* Receive the response block from the device */\r
- if ((ErrorCode = SImage_RecieveBlockHeader()) != PIPE_RWSTREAM_NoError)\r
- {\r
- ShowCommandError(ErrorCode, false);\r
- break;\r
- }\r
-\r
- /* Verify that the command completed successfully */\r
- if ((PIMA_ReceivedBlock.Type != CType_ResponseBlock) || (PIMA_ReceivedBlock.Code != PIMA_RESPONSE_OK))\r
- {\r
- ShowCommandError(PIMA_ReceivedBlock.Code, true);\r
- break;\r
- }\r
-\r
- puts_P(PSTR("Done.\r\n"));\r
-\r
- /* Indicate device no longer busy */\r
- UpdateStatus(Status_USBReady);\r
- \r
- /* Wait until USB device disconnected */\r
- while (USB_IsConnected);\r
- \r
- break;\r
- }\r
-}\r
-\r
-/** Function to convert a given Unicode encoded string to ASCII. This function will only work correctly on Unicode\r
- * strings which contain ASCII printable characters only.\r
- *\r
- * \param UnicodeString Pointer to a Unicode encoded input string\r
- * \param Buffer Pointer to a buffer where the converted ASCII string should be stored\r
- */\r
-void UnicodeToASCII(uint8_t* UnicodeString, char* Buffer)\r
projects / pub / USBasp.git / blobdiff