一种多传感器融合的近岸无人船SLAM方法

作者：杨萃; 王啸威; 陈芳炯; 宁更新; 陈焱琨

来源：2023-03-10, 中国, CN202310234432.8.

本发明公开了一种多传感器融合的近岸无人船SLAM方法,将激光雷达惯性里程计(LIO)和视觉惯性里程计(VIO)紧密耦合,并利用水面和水岸线的语义信息联合处理数据；利用惯性测量单元前向传播获得无人船状态的先验分布。在LIO中利用点到面的ICP法获得无人船状态的后验分布,配合先验分布更新状态和点云地图。在VIO中利用非水面LiDAR关键点两步追踪法和基于水岸线信息的两步PnP法获得无人船状态的后验分布,配合先验分布更新状态；最终获得无人船的行驶轨迹和周围环境的点云地图。该多传感器融合的近岸无人船SLAM方法,不依赖灰度不变假设,能在强反光的水面环境上工作,不受水面倒影影响,提升了鲁棒性和精确性。

• 出版日期2023-3-10
• 单位华南理工大学