Walking Vibration Suppression for Humanoid Robot Based on Optimal Control
YI Jiang1,2, ZHU Qiuguo1,2, WU Jun1,2, XIONG Rong1,2
1. Institute of Cyber-Systems and Control, Zhejiang University, Hangzhou 310027, China;
2. State Key Laboratory of Industrial Control Technology, Zhejiang University, Hangzhou 310027, China
Abstract:To deal with the vibration brought by the non-rigid characteristics of the leg mechanism during the humanoid robot walking, a walking vibration suppression method is proposed based on optimal control. Firstly, the vibration is modeled, and then the model is added to the original dynamics model of the robot. Then, the preview control method is used to generate a control trajectory subjected to the COM (center of mass) acceleration constraints based on the extended dynamics model, where the trajectory serves as the initial solution of the optimal control problem. And starting from this initial solution, the constrained optimal control problem is solved by iteration method, yielding an optimal control trajectory which suppresses the vibration in a feed forward manner. Finally, contrast walking experiments of the preview control method and the proposed method are performed on the humanoid robot Kong. The experimental results show that the proposed method significantly reduces the oscillation of the ZMP (zero momentum point) and the shaking of the torso during the walking process of the robot. The effectiveness of the method for walking vibration suppression is validated.
[1] Vukobratovic M, Sepaneko Y. On the stability of anthropomorphic systems[J]. Mathematical Biosciences, 1972, 15(1): 1-37.
[2] Huang Q, Kaneko K, Yokoi K, et al. Balance control of a piped robot combining off-line pattern with real-time modification[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2000: 3346-3352.
[3] Kajita S, Morisawa M, Miura K, et al. Biped walking stabilization based on linear inverted pendulum tracking[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2010: 4489-4496.
[4] Yamane K, Nakamura Y. Dynamics filter-Concept and implementation of online motion generator for human figures[J]. IEEE Transactions on Robotics and Automation, 2003, 19(3): 421-432.
[5] Takenaka T, Matsumoto T, Yoshiike T, et al. Real time motion generation and control for biped robot-1st report: Running gait pattern generation[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2009: 1084-1091.
[6] Ha I, Tamura Y, Asama H. Gait pattern generation and stabilization for humanoid robot[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2011: 3207-3212.
[7] 汪柳青,尚伟伟.基于线性耦合振荡器模型的仿人机器人步态规划算法 [J].中国科学技术大学学报,2014,44(10):795-803.Wang L Q, Shang W W. A gait pattern planning algorithm based on linear coupled oscillator model for humanoid robots[J]. Journal of University of Science and Technology of China, 2014, 44(10): 795-803.
[8] Yi J, Zhu Q G, Xiong R, et al. Vibration suppression based on input shaping for biped walking[C]//IEEE-RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2016: 236-241.
[9] 邹律龙,余义斌.柔性臂工业机器人振动控制的研究 [J].机床与液压,2009,37(2):122-125.Zou L L, Yu Y B. Study on vibration control for flexible beam robot[J]. Machine Tool & Hydraulics, 2009, 37(2): 122-125.
[10] 娄军强,魏燕定,杨依领,等.智能柔性机械臂的建模和振动主动控制研究 [J].机器人,2014,36(5):552-559.Lou J Q, Wei Y D, Yang Y L, et al. Modeling and active vibration control of an intelligent flexible manipulator system[J]. Robot, 2014, 36(5): 552-559.
[11] 葛宏伟,史伟民,杨亮亮,等.基于脉冲整形的码垛机器人残余振动抑制研究 [J].浙江理工大学学报,2016,35(1):58-63.Ge H W, Shi W M, Yang L L, et al. Research on residual vibration suppression of robot palletizer based on pulse shaping[J]. Journal of Zhejiang Sci-Tech University, 2016, 35(1): 58-63.
[12] Malzahn J, Ruderman M, Phung A S, et al. Input shaping and strain gauge feedback vibration control of an elastic robotic arm [C]//IEEE Conference on Control and Fault-Tolerant Systems. Piscataway, USA: IEEE, 2010: 672-677.
[13] Kim J H, Oh J H. Walking control of the humanoid platform KHR-1 based on torque feedback control[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2004: 623-628.
[14] Kajita S, Kanehiro F, Kaneko K, et al. Biped walking pattern generation by using preview control of zero-moment point[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2003: 1620-1626.
[15] 张雷,郭科.最优控制方法及其应用 [M].成都:四川大学出版社,2012.Zhang L, Guo K. Optimal control method and its application [M]. Chengdu: Sichuan University Press, 2012.
[16] Wang Y L, Xiong R, Zhu Q G, et al. Compliance control for standing maintenance of humanoid robots under unknown external disturbances[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2014: 2297-2304.