Standing Balance Control of Humanoid Robot Based on Three-link Dynamic Model
ZHU Qiuguo1, WU Haoxian1, WU Jun1, XIONG Rong1,2
1. State Key Laboratory of Industrial Control Technology, Zhejiang University, Hangzhou 310027, China;
2. Key Laboratory of Soft Machines and Smart Devices of Zhejiang Province, Hangzhou 310027, China
Abstract:In order to solve the anti-disturbance control problem for humanoid robot standing balance, a three-link dynamic model is proposed as the simplified model of humanoid robot, in which the distributed mass of the leg, body and arm on their links is considered. Thus, the model will be more accurate than the traditional linear inverted pendulum or the plus flywheel model. Based on this model, an anti-disturbance controller is designed for humanoid robot standing balance. Firstly, the humanoid is simplified as the three-link model, the structural parameters are obtained by parameter identification method, and the complex nonlinear dynamics model is linearized by linearization. Then, the balance controller is designed by using the linear quadratic regulator (LQR). The experiments are carried out on the humanoid robot KONG-II, and the ankle joint is set up as an under-actuated state with certain damping characteristics to match the three-link model. By comparing the anti-disturbance performance of the robots with double-link dynamic model and with three-link dynamic model, the effectiveness and robustness of the proposed method are verified.
[1] Azevedo C, Espiau B, Amblard B, et al. Bipedal locomotion: Toward unified concepts in robotics and neuroscience[J]. Biological Cybernetics, 2007, 96(2): 209-228.
[2] Runge C F, Shupert C L, Horak F B, et al. Ankle and hip postural strategies defined by joint torques[J]. Gait and Posture, 1999, 10(2): 161-170.
[3] Horak F B, Nashner L M. Central programming of postural movements: Adaptation to altered support-surface configurations[J]. Journal of Neurophysiology, 1986, 55(6): 1369-1381.
[4] Vukobratovic M, Stepanenko J. On the stability of anthropomorphic systems[J]. Mathematical Biosciences, 1972, 15(1-2): 1-37.
[5] Pratt J, Carff J, Drakunov S, et al. Capture point: A step toward humanoid push recovery[C]//6th IEEE-RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2006: 200-207.
[6] Pratt J, Koolen T, de Boer T, et al. Capturability-based analysis and control of legged locomotion, Part 2: Application to M2V2, a lower-body humanoid[J]. International Journal of Robotics Research, 2012, 31(10): 1117-1133.
[7] Wight D L, Kubica E G, Wang D W L. Introduction of the foot placement estimator: A dynamic measure of balance for bipedal robotics[J]. Journal of Computational and Nonlinear Dynamics, 2008, 3(1): 82-93.
[8] Yun S K, Goswami A. Momentum-based reactive stepping controller on level and non-level ground for humanoid robot push recovery[C]//IEEE/RSJ International Conference on Intelligent Robots and System. Piscataway, USA: IEEE, 2011: 3943-3950.
[9] Stephens B. Humanoid push recovery[C]//IEEE-RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2007: 589-595.
[10] Goswami A, Kallem V. Rate of change of angular momentum and balance maintenance of biped robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2004: 3785-3790.
[11] Li Z B, Tsagarakis N G, Caldwell D G. A passivity based admittance control for stabilizing the compliant humanoid COMAN [C]//IEEE-RAS International Conference on Humanoid Robots. Piscataway, USA: IEEE, 2012: 43-49.
[12] Wang Y L, Xiong R, Zhu Q G, et al. Compliance control for standing maintenance of humanoid robots under unknown external disturbance[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 2014: 2297-2304.
[13] Spong M W. Partial feedback linearization of underactuated mechanical systems[C]//IEEE/RSJ/GI International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 1994: 314-321.
[14] Spong M W. The swing up control problem for the acrobot[J]. IEEE Control Systems Magazine, 1994, 15(1): 49-55.
[15] Spong M W. Energy based control of a class of underactuated mechanical systems[C]//13th IFAC World Congress. Oxford, UK: Pergamon, 1996: 431-435.
[16] Brown S C, Passino K. Intelligent control for an acrobot[J]. Journal of Intelligent and Robotic Systems, 1997, 18(3): 209-248.
[17] Fantoni I, Lozano R, Spong M W. Energy based control of the pendubot[J]. IEEE Transactions on Automatic Control, 2000, 45(4): 725-729.
[18] Zhu Q G, Wu H X, Yi J, et al. Push recovery for humanoid robots with passive damped ankles[C]//IEEE International Conference on Robotics and Biomemetics. Piscataway, USA: IEEE, 2015: 1578-1583.