Fixed logic error with multiple waypoints and compass correction.