geometry_msgs/Pose2D start geometry_msgs/Pose2D control1 geometry_msgs/Pose2D control2 geometry_msgs/Pose2D end