#goal definition
std_msgs/Float32 height
---
#result definition
std_msgs/Bool position_reached
---
#feedback
geometry_msgs/PoseStamped current_position