Function cl_nav2z::makePureStraightSubPlan

Function Documentation

geometry_msgs::msg::PoseStamped cl_nav2z::makePureStraightSubPlan(const geometry_msgs::msg::PoseStamped &startOrientedPose, const geometry_msgs::msg::Point &goal, double length, std::vector<geometry_msgs::msg::PoseStamped> &plan)