Path planning, Trajectory, Waypoints