diff --git a/Com_server/fly_monitor/src/Com_SerialWritingThread.cpp b/Com_server/fly_monitor/src/Com_SerialWritingThread.cpp index d4a595ec8e61d74c5938a8b9eeb37eb53d28e21d..cd7d96b07402fd337bc56141fd7290d844097ddf 100644 --- a/Com_server/fly_monitor/src/Com_SerialWritingThread.cpp +++ b/Com_server/fly_monitor/src/Com_SerialWritingThread.cpp @@ -196,25 +196,25 @@ int Serial_Port_WritingThread::main_loop(struct timeval *front_msg, struct timev } } - if(blc_control_commands.floats[0]>0.7 && drone1.motors == DISARM) + if(blc_control_commands.floats[6]>0.7 && drone1.motors == DISARM) { cout<<"Arming\n"; drone1.command_arm(1); } - if(blc_control_commands.floats[1]>0.7 || (blc_control_commands.floats[0]>0.7 && drone1.motors == ARM)) + if(blc_control_commands.floats[7]>0.7 || (blc_control_commands.floats[6]>0.7 && drone1.motors == ARM)) { cout<<"Disarming\n"; drone1.command_arm(0); } - if(blc_control_commands.floats[2]>0.7 && drone1.motors == ARM) + if(blc_control_commands.floats[8]>0.7 && drone1.motors == ARM) { cout<<"Takeoff\n"; drone1.take_off(); } - if(blc_control_commands.floats[3]>0.7 && drone1.motors == ARM) + if(blc_control_commands.floats[9]>0.7 && drone1.motors == ARM) { cout<<"Landing\n"; drone1.landing();