Trajectory planning under vehicle dimension constraints using sequential linear programming
rapidly - exploring random trees : a new tool for path planning .