一种机器人定位与建图的数据融合处理方法
Abstract:
本发明提供了一种机器人定位与建图的数据融合处理方法,包括以下步骤:预测机器人当前时刻的状态向量;根据上一时刻的协方差矩阵和噪声协方差矩阵计算当前时刻预测误差协方差矩阵;预测当前时刻的偏移信息差量;获取机器人的观测量,根据当前时刻的偏移信息差量、预测状态向量、预测误差协方差矩阵和观测量获得联合后验概率密度函数;对初始的迭代参数进行赋值,根据变分推断方法对联合后验概率密度函数进行迭代更新,直至满足变分推断的迭代条件后结束迭代更新,获得当前时刻机器人的融合数据。本发明对机器人状态向量和偏移信息差量的联合估计,降低测量数据和视觉信息的时间差对融合数据的精度影响,提高机器人的自身位姿定位精度。
Public/Granted literature
Patent Agency Ranking
0/0