基于三连杆动力学模型的仿人机器人站立平衡控制.PDFVIP

第38 卷第4 期 机器人 ROBOT Vol.38, No.4 2016 年7 月 Jul., 2016 DOI ：10.13973/j.cnki.robot.2016.0451 基于三连杆动力学模型的仿人机器人站立平衡控制 1 1 1 12 朱秋国 ，伍浩贤 ，吴 俊 ，熊 蓉 （1. 浙江大学工业控制技术国家重点实验室，浙江 杭州 310027； 2. 浙江省软体机器人与智能器件研究重点实验室，浙江 杭州 310027 ） 摘 要：为了解决仿人机器人抗扰动站立平衡控制问题，提出了一种三连杆动力学模型作为仿人机器人的简 化模型，该模型充分考虑了机器人腿部、身体和手臂的连杆分布质量，相比于传统的线性倒立摆模型或者飞轮倒 立摆模型具有更高的精确性．基于这种模型，设计了仿人机器人的站立抗扰动平衡控制器．首先将仿人机器人模 型简化为三连杆动力学模型，通过参数辨识方法获取结构化的参数，并经过线性化处理，将复杂的非线性动力学 模型线性化．然后采用线性二次调节器（LQR ）设计机器人的平衡控制器．实验在仿人机器人KONG-II 上进行， 通过将机器人踝关节设置成具有一定阻尼特性的欠驱动状态，来实现三连杆动力学模型的形式．实验结果对比了 机器人采用两连杆动力学模型和三连杆动力学模型时的抗外力扰动性能，验证了本文方法的有效性和鲁棒性． 关键词：仿人机器人；站立平衡控制；三连杆动力学模型；线性二次调节器 中图分类号：TP273 文献标识码：A 文章编号：1002-0446(2016)-04-0451-07 Standing Balance Control of Humanoid Robot Based on Three-link Dynamic Model ZHU Qiuguo1 ，WU Haoxian1 ，WU Jun1 ，XIONG Rong12 (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 st