Walking Control for Humanoid Robot Based on ZMP Error Correction
FU Genping1, YANG Yimin1, CHEN Jianping2, LI Jing1
1. School of Automation, Guangdong University of Technology, Guangzhou 510090, China;
2. School of Computer, Zhaoqing University, Zhaoqing 526061, China
付根平, 杨宜民, 陈建平, 李静. 基于ZMP误差校正的仿人机器人步行控制[J]. 机器人, 2013, 35(1): 39-44.DOI: 10.3724/SP.J.1218.2013.00039.
FU Genping, YANG Yimin, CHEN Jianping, LI Jing. Walking Control for Humanoid Robot Based on ZMP Error Correction. ROBOT, 2013, 35(1): 39-44. DOI: 10.3724/SP.J.1218.2013.00039.
Both undesirable walking environment and external perturbations will cause the ZMP (zero moment point) error and affect the walking stability of the humanoid robot. Since ZMP is affected by angles of all robot joints, it is difficult to achieve good walking-control performance if only correcting the ankle or hip angles of the support leg. Therefore, considering the influence of all joint angles on ZMP, the way to calculate the CoM (center of mass) position displacement of robot is studied by fuzzy controller based on ZMP error. Then angle corrections of all joints to match the CoM position displacement are computed by using quadratic programming and CoM Jacobian matrix. The simulation results show that by this method, the desired ZMP trajectory can be tracked very well, and the walking stability margin is improved, which helps the humanoid robot walk stably.
[1] Vukobratovic M, Borovac B. Zero-moment point—Thirty five years of its life[J]. International Journal of Humanoid Robotics, 2004, 1(1): 157-173. [2] Kim J Y, Park I W, Oh J Y. Walking control algorithm of biped humanoid robot on uneven and inclined floor[J]. Journal of Intelligent and Robotic Systems, 2007, 48(4): 457-484. [3] Chestnutt J, Lau M, Cheung G, et al. Footstep planning for the Honda ASIMO humanoid[C]//IEEE International Conference on Robotics and Automation. Piscataway, NJ, USA: IEEE, 2005: 629-634.[4] Akachi K, Kaneko K, Kanehira N, et al. Development of humanoid robot HRP-3P[C]//IEEE/RAS International Conference on Humanoid Robots. Piscataway, NJ, USA: IEEE, 2005: 50-55.[5] Peter S, Jaroslav T, Zlatko F, et al. Development of cognitive capabilities for robot Nao in center for intelligent technologies in Kosice[C]//2011 2nd International Conference on Cognitive Infocommunications. Piscataway, NJ, USA: IEEE, 2011: 1-5.[6] 梶田秀司.仿人机器人[M].管贻生,译.北京:清华大学出版社,2007. Kajita S. Humanoid robots[M]. Guan Y S, Trans. Beijing: Tsinghua University Press, 2007.[7] Kim S, Kim C H, You B, et al. Stable whole-body motion generation for humanoid robots to imitate human motions[C] //IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, NJ, USA: IEEE, 2009: 2518-2524.[8] Huang Q, Yokoi K, Kajita S, et al. Planning walking patterns for a biped robot[J]. IEEE Transactions on Robotics and Automation, 2001, 17(3): 280-289. [9] Raibert M, Tzafestas S, Tzafestas C. Comparative simulation study of three control techniques applied to a biped robot[C]// IEEE International Conference on Systems, Man, and Cybernetics. Piscataway, NJ, USA: IEEE, 1993: 494-502.[10] Stasse O, Verrelst B, Vanderborght B, et al. Strategies for humanoid robots to dynamically walk over large obstacles[J]. IEEE Transactions on Robotics, 2009, 25(4): 960-967. [11] Huang Q, Yoshihiko N. Sensory reflex control for humanoid walking[J]. IEEE Transactions on Robotics, 2005, 21(5): 977-984. [12] 王丽杨,刘治,赵之光,等.一种小样本支持向量机控制器在两足机器人步态控制的研究[J]. 控制理论与应用,2011,28(8):1133-1139. Wang L Y, Liu Z, Zhao Z G, et al. Support-vector-machines learning controller based on small sample sizes for biped robots[J]. Control Theory & Applications, 2011, 28(8): 1133-1139.[13] Kaynov D, Soueres P, Pierro P, et al. A practical decoupled stabilizer for joint-position controlled humanoid robots[C] //IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, NJ, USA: IEEE, 2009: 3392-3397.[14] 付根平,杨宜民,黄春林.基于粒子群优化算法的双足机器人步态优化[J].华中科技大学学报:自然科学版,2011,39(S2):355-358. Fu G P, Yang Y M, Huang C L. Walking pattern optimization based on particle swarm optimization for biped robot[J]. Journal of Huazhong University of Science and Technology: Natural Science Edition, 2011, 39(S2): 355-358.