传感器:声纳+惯性+视觉
提出一种实时SLAM算法,融合视觉,惯性,距离信息。
重点: 怎样融合声呐信息.
系统框图:
以OKIVS为框架, 融合声纳信息.

硬件配置:
- IDS UI-3251LE cameras *2
15帧/s, 1600x1200 - IMAGENEX 831L Sonar
最大探测距离6m; 角分辨率: 0.9°; 完整扫描6m范围耗时6s - Microstrain 3DM-GX4-15 IMU
100Hz - Bluerobotics Bar30 pressure sensor
15Hz - Intel NUC

系统概览
通过最小化重投影误差,IMU误差和声纳距离误差的联合估计来估计机器人R的状态XR。
- 状态向量:
![(左至右均为世界坐标系) 状态向量 = [位置, 姿态的四元数, 线速度, 陀螺仪误差, 加速度计误差]](https://i-blog.csdnimg.cn/blog_migrate/fc3d437f1a4c6c301c80572019f829a2.png#pic_center)
非线性优

2645

被折叠的 条评论
为什么被折叠?



