Changed navigation to single rotate and advance per waypoint