Robust adaptive terrain-relative navigation