Guided Trajectory Filtering for Challenging Long-range AUV Navigation