周浩然, 刘成菊, 安康, 陈启军. 基于物体路标的仿人机器人实时里程计[J]. 信息与控制, 2021, 50(2): 204-215. DOI: 10.13976/j.cnki.xk.2021.2320
引用本文: 周浩然, 刘成菊, 安康, 陈启军. 基于物体路标的仿人机器人实时里程计[J]. 信息与控制, 2021, 50(2): 204-215. DOI: 10.13976/j.cnki.xk.2021.2320
ZHOU Haoran, LIU Chengju, AN Kang, CHEN Qijun. Real Time Odometer for Humanoid Robot Based on Object Landmarks[J]. INFORMATION AND CONTROL, 2021, 50(2): 204-215. DOI: 10.13976/j.cnki.xk.2021.2320
Citation: ZHOU Haoran, LIU Chengju, AN Kang, CHEN Qijun. Real Time Odometer for Humanoid Robot Based on Object Landmarks[J]. INFORMATION AND CONTROL, 2021, 50(2): 204-215. DOI: 10.13976/j.cnki.xk.2021.2320

基于物体路标的仿人机器人实时里程计

Real Time Odometer for Humanoid Robot Based on Object Landmarks

  • 摘要: 仿人机器人运动方式特殊,目前还没有成熟的里程计方案.针对仿人机器人,提出了一种基于物体路标的低成本实时里程计.算法以环境中的物体作为路标,由4个模块组成.视觉测量中对单目相机图像进行分割及形态学处理以识别路标,并结合先验信息估计机器人位姿;运动学里程计中根据关节角度数据通过正运动学计算机器人姿态得到里程计增量;滤波修正中通过无迹卡尔曼滤波用多组路标的视觉测量信息对运动学里程计进行修正;模型修正中以里程计滤波修正前后数据作为训练样本,视觉无效时使用广义回归神经网络对运动学里程计进行修正.本文在NAO型仿人机器人上对算法进行了仿真和实体实验验证.结果表明,算法的平均位置误差不超过3 cm,姿态角误差约为2°,程序平均耗时为7.94 ms,算法具有较高的精度和良好的实时性.

     

    Abstract: Due to the difficulties associated with the special walk mode, there is currently no reliable odometer scheme for the humanoid robot. We propose a real-time, low-cost odometer based on object landmarks for the humanoid robot. The proposed odometer algorithm takes objects in the environment as landmarks and has four modules: the visual measurement, kinematic odometer, filtering correction, and model correction modules. For visual measurement, the monocular camera image is segmented and processed with the morphological method to identify and locate the landmarks, which are then used for estimating the robot pose based on prior information. In the kinematic odometer module, based on the joint angle data, the robot posture is calculated using robot kinematics, and the odometer increment is obtained by the difference. To realize filtering correction, an unscented Kalman filter is used to correct the kinematic odometer based on multiple sets of visual landmark measurements. For model correction, correction data is used as the training dataset. If the visual measurement is determined to be invalid, a generalized regression neural network is used to correct the kinematic odometer. To verify the proposed algorithm, we used the NAO robot as the experimental object. In the experiments, the average localization error was less than 3 cm and the attitude angle was approximately 2°, with an average program execution time of 7.94 ms. The proposed algorithm has high localization accuracy and excellent real-time performance.

     

/

返回文章
返回