geometry_msgs/Pose body geometry_msgs/Vector3[] leg_tips --- float64[] angles