Control Method of a Load-Carrying Quadruped Walking Vehicle with Trotting GaitBased on the Centroidal Dynamics and the Virtual Model
TAN Yongying1, CHAO Zhiqiang1, HAN Shousong1, NING Chuming2
1. Department of Automobile Engineering, Academy of Army Armored Forces, Beijing 100072, China; 2. Quartermaster Equipment Research Institute, Academy of Military Sciences, Beijing 100039, China
谭永营, 晁智强, 韩寿松, 宁初明. 基于重心动力学及虚拟模型的负载型四足步行平台对角步态控制方法[J]. 机器人, 2020, 42(4): 448-459.DOI: 10.13973/j.cnki.robot.190529.
TAN Yongying, CHAO Zhiqiang, HAN Shousong, NING Chuming. Control Method of a Load-Carrying Quadruped Walking Vehicle with Trotting GaitBased on the Centroidal Dynamics and the Virtual Model. ROBOT, 2020, 42(4): 448-459. DOI: 10.13973/j.cnki.robot.190529.
Abstract:A control method combining the centroidal dynamics and the virtual model is proposed, in order to improve the walking stability of a load-carrying quadruped walking vehicle with trotting gait and to reduce the influence of large leg mass and eccentric mass on stable walking. The accelerations of the vehicle body and the swing-legs are solved by using the virtual model control method. Combined with the centroidal dynamics model, the external forces on the vehicle are obtained. Then, the quadratic programming is applied to distributing the resultant external forces to the supporting legs. The joint moments of the walking vehicle are obtained by using the inverse dynamics and the PD (proportional-differential) control in the joint space. Adams and Simulink are used to simulate the trotting gait of the load-carrying quadruped walking vehicle, and comparisons are made between the proposed algorithm and the virtual model control algorithm. Results show that the centroidal dynamics and virtual model control method can stabilize the attitudes of the vehicle around the target values. And the roll and pitch angles of the vehicle are reduced by 42% and 21.8% respectively under a lateral impact, and reduced by 50% and 89% respectively during omni-directional walking with a vehicle eccentric weight. Therefore, the proposed control method can effectively deal with the influence of large leg mass and eccentric mass, and improve the walking stability and robustness of the load-carrying quadruped walking vehicle with trotting gait.
[1] Bellicoso C D, Jenelten F, Gehring C, et al. Dynamic locomotion through online nonlinear motion optimization for quadrupedal robots[J]. IEEE Robotics and Automation Letters, 2018, 3(3):2261-2268. [2] Raibert M, Blankespoor K, Nelson G, et al. BigDog, the rough-terrain quadruped robot[J]. IFAC Proceedings Volumes, 2008, 41(2):10823-10825. [3] Kim J H, Lee J W, Oh Y. A theoretical framework for stability regions for standing balance of humanoids based on their LIPM treatment[J]. IEEE Transactions on Systems, Man, and Cybernetics:Systems, 2018, 48(7). DOI:10.1109/TSMC. 2018.2855190. [4] Winkler A W, Mastalli C, Havoutis I, et al. Planning and execution of dynamic whole-body locomotion for a hydraulic quadruped on challenging terrain[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2015:5148-5154. [5] Motoc I M, Sirlantzis K, Spurgeon S, et al. Zero moment point/inverted pendulum-based walking algorithm for the NAO robot[C]//5th International Conference on Emerging Security Technologies. Piscataway, USA:IEEE, 2014:64-66. [6] Pratt J E. Virtual model control of a biped walking robot[R]. Cambridge, USA:MIT, 1995. [7] Winker A W, Havoutis I, Bazeille S, et al. Path planning with force-based foothold adaption and virtual model control for torque controlled quadruped robots[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2014:6476-6482. [8] Zhang G T, Rong X W, Chai H, et al. Torso motion control and toe trajectory generation of a trotting quadruped robot based on virtual model control[J]. Advanced Robotics, 2016, 30(4):284-297. [9] Gehring C, Coros S, Hutter M, et al. Practice makes perfect:An optimization-based approach to controlling agile motions for a quadruped robot[J]. IEEE Robotics & Automation Magazine, 2016, 23(1):34-43. [10] Focchi M, del Prete A, Havoutis I, et al. High-slope terrain locomotion for torque-controlled quadruped robots[J]. Autonomous Robots, 2017, 41(1):259-272. [11] Winkler A W, Bellicoso C D, Hutter M, et al. Gait and trajectory optimization for legged systems through phase-based end-effector parameterization[J]. IEEE Robotics and Automation Letters, 2018, 3(3):1560-1567. [12] Orin D E, Goswami A, Lee S H. Centroidal dynamics of a humanoid robot[J]. Autonomous Robot, 2013, 35(2):161-176. [13] Wensing P M, Orin D E. Improved computation of the humanoid centroidal dynamics and application for whole-body control[J]. International Journal of Humanoid Robotics, 2016, 13(1). DOI:10.1142/S0219843615500395. [14] 巴凯先,孔祥东,朱琦歆,等.液压驱动单元基于位置/力的阻抗控制机理分析与试验研究[J].机械工程学报,2017,53(12):172-185. Ba K X, Kong X D, Zhu Q X, et al. Position/force-based impedance control and their experimental research on hydraulic drive unit[J]. Journal of Mechanical Engineering, 2017, 53(12):172-185. [15] Featherstone R. The calculation of robot dynamics using articulated-body inertias[J]. International Journal of Robotics Research, 1983, 2(1):13-30. [16] Roberson R E, Schwertassek R. Dynamics of multibody systems[M]. Berlin, Germany:Springer, 1988. [17] Lee S H, Goswami A. A momentum-based balance controller for humanoid robots on non-level and non-stationary ground[J]. Autonomous Robots, 2012, 33(4):399-414. [18] Featherstone R. Rigid body dynamics algorithms[M]. Berlin, Germany:Springer, 2008:65-87. [19] Mistry M, Buchli J, Schaal S. Inverse dynamics control of floating base systems using orthogonal decomposition[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2010:3406-3412. [20] 陈腾,李贻斌,荣学文.四足机器人动步态下实时足底力优化方法的设计与验证[J].机器人,2019,41(1):1-10. Chen T, Li Y B, Rong X W. Design and verification of real time plantar force optimization for quadruped robots in dynamic gait[J]. Robot, 2019, 41(1):1-10. [21] Gehring C, Coros S, Hutter M, et al. Control of dynamic gaits for a quadrupedal robot[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA:IEEE, 2013:3287-3292. [22] 张国腾,荣学文,李贻斌,等.基于虚拟模型的四足机器人对角小跑步态控制方法[J].机器人,2016,38(1):65-74. Zhang G T, Rong X W, Li Y B, et al. Control of quadrupedal trotting based on virtual model[J]. Robot, 2016, 38(1):65-74.