removed the need for setmode with m100 adapter

This commit is contained in:
dave 2018-10-03 21:43:11 -04:00
parent e5e7500b20
commit 7c438c2323
1 changed files with 1 additions and 3 deletions

View File

@ -165,7 +165,7 @@ void roscontroller::RosControllerRun()
flight_controller_service_call(); flight_controller_service_call();
// Broadcast local position to FCU // Broadcast local position to FCU
if(BClpose) if(BClpose)
SetLocalPosition(goto_pos[0], goto_pos[1], goto_pos[2], goto_pos[3]); SetLocalPosition(goto_pos[0], goto_pos[1], goto_pos[2], goto_pos[3]);
// Set ROBOTS variable (swarm size) // Set ROBOTS variable (swarm size)
get_number_of_robots(); get_number_of_robots();
buzz_utility::set_robot_var(no_of_robots); buzz_utility::set_robot_var(no_of_robots);
@ -762,7 +762,6 @@ script
Arm(); Arm();
// Registering HOME POINT. // Registering HOME POINT.
home = cur_pos; home = cur_pos;
BClpose = true;
} }
if (current_mode != "GUIDED" && setmode) if (current_mode != "GUIDED" && setmode)
SetMode("GUIDED", 2000); // added for compatibility with 3DR Solo SetMode("GUIDED", 2000); // added for compatibility with 3DR Solo
@ -792,7 +791,6 @@ script
{ {
armstate = 0; armstate = 0;
Arm(); Arm();
BClpose = false;
} }
if (mav_client.call(cmd_srv)) if (mav_client.call(cmd_srv))
{ {