第 36卷 第 4 期 国防科技大学学报 Vol.36No.4
2014 年 8 月
____________
JOURNAL OF NATIONAL UNIVERSITY OF DEFENSE T E C H NOLOGY_______________Aug. 2014
doi:10. l ! 8 7 / j . cn. 2 0 1 4 0 4 0 2 5 h t p :// jo um al. nudt. edu. cn
四足机器人对角小跑动态控制*
谢惠祥,罗自荣,尚建忠
( 国 防 科 技 大 学 机 电 工 程 与 自 动 化 学 院 ,湖 南 长 沙 4 1 0 07 3 )
摘 要 :基于虚拟模型控制方法,根据四足机器人单腿雅克比矩阵得到支撑相与摆动相的控制法则。为
实现机器人躯体的完全控制,提出了一种控制目标分解的方法,将四足机器人躯体的控制目标分解到每条支
撑腿的控制上。通过构建每条支撑腿的虚拟构件,并将虚拟构件产生的虚拟力转换为期望关节力矩,从而实
现支撑腿的虚拟模型控制;实时规划摆动足的运动轨迹,利用虚拟构件连接摆动腿的足端与期望的摆动轨
迹,实现摆动腿的虚拟模型控制。在设定四条腿的相位轮换规律的基础上,对一个四足机器人二维平面模型
进行对角小跑步态下的速度控制及抗干扰仿真试验。仿真结果证明该控制方法能够有效控制机器人躯体的
高度、速度及倾角,实现四足机器人对角小跑运动的动态控制并具有一定的抗冲击干扰能力。
关 键 词 :四足机器人;虚拟模型控制;对角小跑步态;运动控制
中 图 分 类 号 :T P 2 4 2 文 献 标 志 码 :A 文 章 编 号 :! 0 ] - 2 4 8 6 ( 2 0 1 4 ) 0 4 - 0 1 4 6 - 0 6
Dynamic control for quadrupedal trotting locomotion
XIE Huixiang ’ LUO Zirong ’ SHANG Jianzhong
(College of Mechatronics and Automation, National University of Defense Technology, Changsha 4 10 0 73 ,China)
Abstract: Based on Vimual Model Control method,the contol laws of the single leg for stance phase and swing phase were obtained from the
single leg Jacobian of t e quadruped robot. In order to realize the full body contol,a decomposed method was proposed,which decomposes t e body
control objectives of the quadruped robot into each standing leg control. The virtual components of each standing leg were set u p ,and t e virtual forces
were transformed into desired joint torques to achieve the virtual model control for standing leg. The swing foot trajectories were planned in real time
and the virtual components were used to connect the swing foot and the planned trajectcQes, so that the virtual model control for swing leg was
realized. Based on the switching mle of the leg phase sequence,simulations about velocity control and disturbance rejection were studied with a planar
quadruped model using trotting gait. The simulation results vemfied that the proposed control method is effective in height,speed and pitch angle
contol of the bod y,can achieve dynamic control of the quadrupedal totting locomotion,and is robust for disturbance rejection.
K e y w o r d s : quadruped robot; virtual model control; totting gait; locomotion control
足式机器人是多输入、多输出的非线性动力
学系统,要实现其平衡控制具有很大的难度。 目
前比较常见的足式机器人控制方法主要有3 种 :
零力矩点(Zero Moment Point, Z M P ) 控制方法、中
枢神经模式(Central Pattern Generator, C P G ) 控制
和虚拟模型控制(Vitual Model Control,V M C )。
基 于 Z M P 的控制方法能够实现足式机器人
稳定步行、通过崎岖地形甚至抵抗冲击干扰[卜2]。
但是该方法由于需要实时规划质心与足端轨迹,
再通过逆运动学求解各关节运动轨迹,计算量大、
效率低,因此只适用于低速步行。而且对于点式
足底的四足机器人,在没有明显支撑多边形的步
态下(如对角小跑)无 法 满 足 Z M P 控制条 件。基
于 C P G 的控制方法能够实现腿部节律运动与步
态转换[_5],但 是 C P G 网络不能很好地和高层控
制决策与底层反馈信号融合,且缺少对机器人躯
体姿态的有效控制。
Pratt等[]提出了 V M C 方 法 ,实现了双足机
器人的动态步行控制[_8]。C h e w 等[]在 V M C 的
基础上加入了学习算法,实现控制参数的自我整
定 。V M C 方法综合考虑了机器人躯体位置、速度
及姿态的控制,并且不涉及逆运动学求解与关节
轨迹跟踪,控制效 率 较 高。陈佳品等[!」将 V M C
方法应用到四足机器人上,但是只限于虚拟模型
的 理 论 推 导 ,没 有 相 关 的 仿 真 或 实 验 验 证 。
Ajalloeian等 []」利 用 V M C 进行机体姿态控制的
* 收 稿 日 期 :
基 金 项 目 :国 家 高 技 术 研 究 发 展 计 划 资 助 项 目 (2 0 1 1 A A 0 4 0 8 0 !
作 者 简 介 :i射 惠 祥 (! 85— ) ,男 ,广 西 贵 港 人 ,博 士 研 究 生 ,E-mail:xhx-nudt@ hotmail. c o m ;
尚 建 忠 (通 讯 作 者 ),男 ,博 士 ,教 授 ,博 士 生 导 师 ,E-mail : jianzhongshang@ gmail. c om