用于SLAM过程的基于差分进化算法进行BA问题求解的方法
摘要:
本发明公开了一种用于SLAM过程的基于差分进化算法进行BA问题求解的方法,属于移动机器人同步定位与地图构建(Simultaneous Localization and Mapping,SLAM)领域,包括以下步骤:读取机器人的视觉图像,提取当前帧与上一帧图像的特征点,并获取所有匹配的特征点对;计算上一帧图像中与当前帧图像相匹配的所有特征点各自对应的空间坐标;根据空间坐标的重投影误差计算误差函数;利用差分进化算法求取误差函数的最优解所对应的相机的位姿即完成BA问题的求解。本发明的方法能够避免现存方法中需要进行求导运算而导致运算量过大的问题,能够减小BA过程的计算量,保证SLAM过程的实时性与快速性。
0/0