Navigate to a waypoint using direction and position.

[andycondon]

• Navigation only, no obstacle avoidance.
• Go to next waypoint once one is reached until no more waypoints.