一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法

摘要

本发明公开一种考虑地图准确性的水下机器人海底地形匹配导航路径规划方法，属于水下机器人领域。本发明包括：建立环境模型，结合海底地形特征和地图数据准确程度两部分信息，依据Sigmoid函数将标准差信息非线性映射至[0，1]空间，形成归一化的海底地形特征图；实施H‑RRT*算法进行路径求解，求解过程为迭代‑采样‑寻优的过程。路径规划方法能够充分利用已有信息，如海底地形特征和地图测量数据来源，作为影响水下机器人地形匹配导航性能的因素考虑在内；路径规划方法搜索性能强，可以实现超大地图下的路径搜索和寻优。