低成本视觉-惯性融合的SLAM方法
    1.
    发明公开

    公开(公告)号:CN116659490A

    公开(公告)日:2023-08-29

    申请号:CN202310585303.3

    申请日:2023-05-22

    Abstract: 本发明公开了一种低成本视觉和惯性融合的SLAM方法,步骤包括:步骤S1、通过MCU对相机与IMU进行时间同步,并读取原始数据;步骤S2、对每帧图像进行FAST角点检测,并挑选关键帧;步骤S3、利用IMU原始数据粗略解算初始两个关键帧之间的位姿关系,并进行三角测量,获取深度信息,从而完成初始化;步骤S4、使用光流算法跟踪角点特征,计算当前帧和地图帧之间的光度误差作为残差;步骤S5、计算卡尔曼增益和修正方程;步骤S6、更新误差状态卡尔曼滤波器的状态;步骤S7、重置滤波器误差和协方差矩阵;步骤S8、更新轨迹并注册地图。本发明是一种可以部署在低成本处理器上的高效快速的定位方法。

Patent Agency Ranking