Herowaree

client_example

May 15th, 2020
87
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.75 KB | None | 0 0
  1. #include <mrs_msgs/ReferenceStampedSrv.h>
  2.  
  3. #include <mrs_msgs/Reference.h>
  4. #include <std_msgs/Header.h>
  5.  
  6. // Client
  7. ros::ServiceClient fc_srv_client_goto_;
  8.  
  9. fc_srv_client_goto_ = nh.serviceClient<mrs_msgs::ReferenceStampedSrv>("/"+ uav_name_ +"/control_manager/reference");
  10.  
  11. // Create msg for client
  12. mrs_msgs::ReferenceStampedSrv srv;
  13. mrs_msgs::Reference ref;
  14. std_msgs::Header h;
  15.  
  16. h.stamp = simulation_time_;
  17. h.frame_id = uav_name_ + "/" + frame_;
  18.  
  19. ref.position.x = (posição x)
  20. ref.position.y = (posição y)
  21. ref.position.z = (posição z)
  22. ref.yaw = (posição yaw)
  23.  
  24. srv.request.reference = ref;
  25. srv.request.header = h;
  26.  
  27. // Request service
  28. if (fc_srv_client_goto_.call(srv)){
  29.  
  30. }else{
  31. ROS_ERROR("Failed to call service.\n");
  32. }
Advertisement
Add Comment
Please, Sign In to add comment