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