一种基于滤波的多传感器融合冰下里程计装置、方法及存储介质

    公开(公告)号:CN118816858A

    公开(公告)日:2024-10-22

    申请号:CN202410632073.6

    申请日:2024-05-21

    Abstract: 本发明提供一种基于滤波的多传感器融合冰下里程计装置,属于水下机器人导航与定位领域。本发明紧耦合双目相机、成像声呐、IMU和深度计,获取冰下的测量信息;可移动物体在冰下作业时,利用搭载的双目相机垂直对上,采集冰盖底部的光学图像;利用搭载的前视声呐对前斜向上倾角30度,采集冰盖底部的视觉图像,并记录惯性测量单元和深度计的实时加速度、角速度和深度数据;根据获得到的多传感器数据,估算可移动物体实时位置与姿态。本发明使用多约束的双目相机观测模型进行测测更新,使用一种高效的亚像素相位相关法估计声呐图像的线速度,使用基于残差的自适应方法估计深度数据声呐线速度的噪声协方差,实现高精度和高鲁棒性的冰下定位与姿态估计。

Patent Agency Ranking