uint8_t PTP_Transaction(uint16_t opCode, uint8_t receive_data, uint8_t paramCount, uint32_t *params, uint8_t dataBytes, uint8_t *data) { if(PTP_Error) return PTP_RETURN_ERROR; if(PTP_Bytes_Remaining > 0) return PTP_FetchData(0); uint8_t err; PTP_Run_Task = 0; // Pause task while we're busy with the transaction if(paramCount > 0 && params) err = SI_Host_SendCommand(&DigitalCamera_SI_Interface, CPU_TO_LE16(opCode), paramCount, params); else err = SI_Host_SendCommand(&DigitalCamera_SI_Interface, CPU_TO_LE16(opCode), 0, NULL); if(!err && dataBytes > 0 && data) // send data { DigitalCamera_SI_Interface.State.TransactionID--; PIMA_Block = (PIMA_Container_t) { .DataLength = CPU_TO_LE32(PIMA_DATA_SIZE(dataBytes)), .Type = CPU_TO_LE16(PIMA_CONTAINER_DataBlock), .Code = CPU_TO_LE16(opCode) }; memcpy(&PIMA_Block.Params, data, dataBytes); err = SI_Host_SendBlockHeader(&DigitalCamera_SI_Interface, &PIMA_Block); }
/** Task to manage an enumerated USB Still Image device once connected, to manage a * new PIMA session in order to send commands to the attached device. */ void StillImageHost_Task(void) { if (USB_HostState != HOST_STATE_Configured) return; puts_P(PSTR("Opening Session...\r\n")); if (SI_Host_OpenSession(&DigitalCamera_SI_Interface) != PIPE_RWSTREAM_NoError) { puts_P(PSTR("Could not open PIMA session.\r\n")); USB_Host_SetDeviceConfiguration(0); return; } puts_P(PSTR("Turning off Device...\r\n")); SI_Host_SendCommand(&DigitalCamera_SI_Interface, 0x1013, 0, NULL); if (SI_Host_ReceiveResponse(&DigitalCamera_SI_Interface)) { puts_P(PSTR("Could not turn off device.\r\n")); USB_Host_SetDeviceConfiguration(0); return; } puts_P(PSTR("Device Off.\r\n")); puts_P(PSTR("Closing Session...\r\n")); if (SI_Host_CloseSession(&DigitalCamera_SI_Interface) != PIPE_RWSTREAM_NoError) { puts_P(PSTR("Could not close PIMA session.\r\n")); USB_Host_SetDeviceConfiguration(0); return; } LEDs_SetAllLEDs(LEDMASK_USB_READY); USB_Host_SetDeviceConfiguration(0); }
/** Main program entry point. This routine configures the hardware required by the application, then * enters a loop to run the application tasks in sequence. */ int main(void) { SetupHardware(); puts_P(PSTR(ESC_FG_CYAN "Still Image Host Demo running.\r\n" ESC_FG_WHITE)); LEDs_SetAllLEDs(LEDMASK_USB_NOTREADY); sei(); for (;;) { switch (USB_HostState) { case HOST_STATE_Addressed: LEDs_SetAllLEDs(LEDMASK_USB_ENUMERATING); uint16_t ConfigDescriptorSize; uint8_t ConfigDescriptorData[512]; if (USB_Host_GetDeviceConfigDescriptor(1, &ConfigDescriptorSize, ConfigDescriptorData, sizeof(ConfigDescriptorData)) != HOST_GETCONFIG_Successful) { puts_P(PSTR("Error Retrieving Configuration Descriptor.\r\n")); LEDs_SetAllLEDs(LEDMASK_USB_ERROR); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } if (SI_Host_ConfigurePipes(&DigitalCamera_SI_Interface, ConfigDescriptorSize, ConfigDescriptorData) != SI_ENUMERROR_NoError) { puts_P(PSTR("Attached Device Not a Valid Still Image Class Device.\r\n")); LEDs_SetAllLEDs(LEDMASK_USB_ERROR); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } if (USB_Host_SetDeviceConfiguration(1) != HOST_SENDCONTROL_Successful) { puts_P(PSTR("Error Setting Device Configuration.\r\n")); LEDs_SetAllLEDs(LEDMASK_USB_ERROR); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } puts_P(PSTR("Still Image Device Enumerated.\r\n")); LEDs_SetAllLEDs(LEDMASK_USB_READY); USB_HostState = HOST_STATE_Configured; break; case HOST_STATE_Configured: puts_P(PSTR("Opening Session...\r\n")); if (SI_Host_OpenSession(&DigitalCamera_SI_Interface) != PIPE_RWSTREAM_NoError) { puts_P(PSTR("Could not open PIMA session.\r\n")); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } puts_P(PSTR("Turning off Device...\r\n")); SI_Host_SendCommand(&DigitalCamera_SI_Interface, 0x1013, 0, NULL); if (SI_Host_ReceiveResponse(&DigitalCamera_SI_Interface)) { puts_P(PSTR("Could not turn off device.\r\n")); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } puts_P(PSTR("Device Off.\r\n")); puts_P(PSTR("Closing Session...\r\n")); if (SI_Host_CloseSession(&DigitalCamera_SI_Interface) != PIPE_RWSTREAM_NoError) { puts_P(PSTR("Could not close PIMA session.\r\n")); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } LEDs_SetAllLEDs(LEDMASK_USB_READY); USB_HostState = HOST_STATE_WaitForDeviceRemoval; break; } SI_Host_USBTask(&DigitalCamera_SI_Interface); USB_USBTask(); } }