Closed-loop terrain relative navigation for AUVs with non-inertial grade navigation sensors