本发明涉及一种基于点线特征的自适应单目VIO初始化方法,属于机器人视觉定位导航技术领域,包括步骤:S1:输入图像帧,分别检测点特征与线特征,输入IMU获取的数据,在图像帧之间进行预积分计算;S2:估计相机初始位姿;S3:构建最大后验估计问题,优化惯性参数,得到尺度因子、速度信息、重力方向以及IMU的陀螺仪偏置和加速度计偏置;S4:视觉惯性对齐、尺度缩放,将相机初始位姿转换到世界坐标系下;S5:初始值收敛。本发明能在不同复杂环境和不同初始状态下完成较为稳定精确的初始化,解决了VIO初始化过程中传感器的不确定性和惯性参数的不一致性,具有更高的性能。
📄 2021101191241
📂 G06T7_00
👤 重庆邮电大学
📅 2021-01-28