Path Planning of Underwater Terrain-Aided Navigation Based on Improved Artificial Potential Field Method