一种基于地形特征匹配的水下地形匹配导航方法

摘要

本发明提供一种基于地形特征匹配的水下地形匹配导航方法，处理先验地图，求出高度的梯度值，利用梯度的大小筛选出实际为较为陡峭的点作为特征点，将这些特征点的梯度进行霍夫变换得到特征的长度及位置，写入实际特征信息库。处理多波束声纳发回的数据，求出对应点的高度值，对其求梯度，将梯度的模长进行霍夫变换，得到样本特征的长度和与机器人的相对位置。利用这些特征的长度、对应深度等信息与之前构建的实际特征信息库进行匹配，得到与每一块特征区域所匹配的先验地图的区域。分别利用这些区域的相对位置信息得出水下机器人的位置，对这些位置进行分析得到机器人的精确位置。本发明可相对快速的地形匹配定位与导航任务。