Function posq

Function Documentation

TrajectoryPtr posq(float x_start, float y_start, float x_goal, float y_goal, float yaw_start, float yaw_goal, float &cost)