一种用于双移动机器人刚体协作搬运的协同定位方法

    公开(公告)号:CN110967017A

    公开(公告)日:2020-04-07

    申请号:CN201911154494.8

    申请日:2019-11-22

    Abstract: 本发明提供一种用于双移动机器人刚体协作搬运的协同定位方法,包括以下步骤:S1、构建基于刚性约束的双机器人系统的运动学模型和量测模型;S2、初始化高斯-厄米特求积分卡尔曼滤波器;S3、基于运动学模型对双机器人系统进行状态推演,得到刚体状态预测值;S4、获取双机器人系统的状态量测值,并且将状态量测值与量测模型相结合计算卡尔曼增益;S5、利用卡尔曼增益对刚体状态预测值进行更新后得到刚体状态估计值;S6、将更新后的刚体状态估计值转换为双机器人系统中的两个移动机器人的位姿状态,其能够融合由不变刚性约束产生的相对距离与方位约束条件限制误差上界,使得估计结果更加接近真实运动轨迹。

Patent Agency Ranking