SMS: Single-heading and shortest-time navigation,