An AUV localization and path planning algorithm for terrain-aided navigation. (August 2020)