本发明通过充分考虑惯性导航系统的导航误差特性，将短时间内的惯性导航精准航向及航行距离信息考虑到地形辅助导航方法中，提高匹配算法的鲁棒性。在初始搜索阶段，根据惯性导航得到的位置信息设置初始搜索范围，并根据水深测量数据进行路径初始化，根据水深测量数据、惯性导航提供的航向及航行距离信息进行路径点筛选，并对得到的路径与惯性导航航行距离进行比较判断是否进行窗口滑动，实现分段匹配定位。在每个分段中根据价值函数进行最终路径确定，完成整条路径的匹配定位。