int DJI_Setup(std::string serial_port, int baudrate) {
int ret;
char uart_name[32];
strcpy(uart_name, serial_port.c_str());
printf("Serial port: %s\n", uart_name);
printf("Baudrate: %d\n", baudrate);
printf("=========================\n");
//Serial Port Init
ret = Pro_Hw_Setup(uart_name, baudrate);
if(ret < 0)
return ret;
//Setup Other Things
DJI_Pro_Setup(NULL);
return 0;
}
int main()
{
if(Pro_Hw_Setup("/dev/ttyAMA0", 230400) < 0)
{
perror( "UAV Serial Port Open ERROR" );
return 0;
}
DJI_Pro_Setup(NULL);
if(init_pm25("/dev/ttyUSB0", 2400) <0)
{
perror( "PM25 Serial Port Open ERROR" );
return 0;
}
DJI_Pro_Register_Transparent_Transmission_Callback(transparent_transission_receive);
while(1)
{
if(run_flag)
{
int nbyte;
nbyte = read_pm25(buffer, 1024);
if (nbyte > 0)
{
transparent_transission_send((uint8_t*)buffer, nbyte);
//printf("%s", buffer);
}
}
sleep(1);
}
close_pm25();
}
int DJI_Pro_Test_Setup(void)
{
int ret,ret1;
activation_msg.app_id = 1014612;
activation_msg.app_api_level = 2;
activation_msg.app_ver = 1;
memcpy(activation_msg.app_bundle_id,"1234567890123456789012", 32);
key = "41369d9f5a2a73a5951c7af3013dd147415cda546755d81bbb1cb722446bcfb3";
//serialport communication
// ret1 = Pro_Hw_Setup("/dev/ttyUSB1",115200); //open machine hand
// if(ret1 < 0)
// {
// Camera_Serial_Close();
// return ret1;
// }
ret = Pro_Hw_Setup("/dev/ttyUSB0",230400); //open M100
if(ret < 0)
{
Camera_Serial_Close();
return ret;
}
/* setup a timer */
signal(SIGALRM, Activation_Alrm);
Pro_Link_Setup();
App_Recv_Set_Hook(App_Recv_Req_Data);
App_Set_Table(set_handler_tab, cmd_handler_tab);
CmdStartThread();
Start_Simple_Task_Thread();
return 0;
}
