This commit is contained in:
David St-Onge 2017-02-20 17:55:25 -05:00
parent f4ce19a7bb
commit 524e317150
1 changed files with 2 additions and 2 deletions

View File

@ -272,8 +272,8 @@ namespace rosbzz_node{
/*prepare the goto publish message */
cmd_srv.request.param5 = goto_pos[0];
cmd_srv.request.param6 = goto_pos[1];
cmd_srv.request.param7 = goto_pos[2];
cmd_srv.request.command = buzzuav_closures::getcmd();
cmd_srv.request.param7 = cur_pos[2]; //force constant altitude after takeoff, goto_pos[2];
cmd_srv.request.command = buzzuav_closures::getcmd();
if (mav_client.call(cmd_srv)){ROS_INFO("Reply: %ld", (long int)cmd_srv.response.success); }
else ROS_ERROR("Failed to call service from flight controller");
cmd_srv.request.command = mavros_msgs::CommandCode::CMD_MISSION_START;