粒子滤波的智能机器人位置自标定算法

简介

为了提升智能机器人位置自标定的精准度、稳定性,降低用时,设计基于粒子滤波的智能机器人位置自标定算法。根据智能机器人相邻连杆位置关系,描述机器人正运动学,通过粒子初始化、位置更新、权值更新、重组的粒子滤波方法标定机器人的模糊位置。根据三球座设备在机器人外部架构世界坐标系,将末端工具坐标系转换到世界坐标系中,令正运动学的起始点从基座变为三球座设备,根据机器人与设备间装配关系建立世界坐标系与基坐标系的变换矩阵,推导出位置自标定的线性模型,完成智能机器人位置自标定。仿真结果表明,该算法的自标定精准度较高、稳定性较高,标定用时较短,修正效果好,能满足快速标定需求。