ComputerEngineering
andApplications计算机工程与应用
2011,47(24)
217
双足机器人动态步行实时步态生成
刘成军1,李祖枢“2,厚之成1
LIU
Chengjunl,LIZushu“2,HOUZhichen91
1.重庆大学智能自动化研究所,重庆400044
2.重庆理工大学计算机科学与工程学院,重庆400050
l-InstituteofIntelligentAutomation,Chongqing2.CoUegeofComputer
Scienceand
University,Chongqing
400044,China
Engineering,ChongqingUniversityofTechnology,Chongqing400050,China
LIU
Chengjun.LI
Zushu.HOUZhieheng.Online
locomotion
patterngeneration
ofdynamicwalking
for
biped
roboL
ComputerEngineeringandApplications。2011.47(24):217・220.
Abstract:Asimpleandintuitiveschemeaboutonlinelocomotionpatterngenerationofdynamicwalkingforbipedrobotis
complex
presented
divided
to
solvethe
jointtrajectory
to
design.The
dynamicsmodelof
a
five・link
of
planarbipedrobotiswalking
for
established.
robotis
Byimitatingthe
byfour
main
characteristics
ofhumanwalking
motion,the
complexprocess
dynamic
biped
sequence
phasesaccording
therequirementsoftheposturechangeoflegsfordynamicwalking.Theloco・
ale
motionpatternoftnmk,themovementofswinglegandsupportleg,themethodofwalkingspeedadjustment
designed
jointanglespace.Thestablejointtrajectoryisgeneratedwithonlinefeedbackcontr01.Simulationtivenessoftheproposedmethodwhichissimpleandeasytoberealized.
inthe
resultshowstheeffec-
Keywords:bipedrobot;dynamicwalking;loeomotion
pattern
generation;control
systems
摘要:针对双足机器人动态步行生成关节运动轨迹复杂问题,提出了一种简单直观的实时步态生成方案。建立了平面五杆双
足机器人动力学模型,通过模仿人类步行主要运动特征并根据双足机器人动态步行双腿姿态变化的要求,将动态步行复杂任务分解为顺序执行的四个过程,在关节空间相对坐标系下设计了躯干运动模式、摆动腿和支撑腿动作及步行速度调整模式,结合当前步行控制结果反馈实时产生稳定的关节运动轨迹。仿真实验验证了该方法的有效性,简单易实现。
关键词:双足机器人;动态步行;步态生成;控制系统DOI:10.377S/j.issn.1002.8331.2011.24.061
文章编号:1002.8331(2011)24.0217.04
文献标识码:A
中图分类号:TP242.6
1引言
双足机器人具有与人类相似的步行运动方式,可以通过狭窄空间、跨越障碍、上下台阶和斜坡,甚至在不平整地面上运动,更适合在人类的生活或工作环境中工作。双足机器人稳
定、快速、自然的步行,对协助人类、与人合作具有重要的意义。
目前,双足机器人步行研究大多把ZMP(ZeroMomentPoint)稳定判据作为步行轨迹产生的基础,基于精确系统模
行机器人。一种步行轨迹产生的方法是基于Poincar6回归映射将步行运动规划为一个完整的虚拟约束㈣。但由于获得
Poinear6映射理论方法的困难性和数值方法计算的复杂性,其
应用仍具有很大的局限性。另外一种方法是基于约束方程产生步行运动轨迹,求解结果是否满足步态的可重复性不直观。本文在分析双足机器人动力学模型的基础上,模仿人类步行
主要运动特征,提出在关节空间相对坐标系下设计躯干运动
型“。21或简化模型如倒立摆模型n卅在绝对坐标系下产生步行轨
迹,求逆计算关节角空问轨迹。基于精确系统模型的方法可
模式、摆动腿和支撑腿动作及步行速度调整模式,结合当前步行控制结果反馈实时产生稳定的关节运动轨迹,并通过仿真实验验证了该方法的有效性,简单易实现。
获得满足ZMP轨迹的确切步行解,但轨迹产生较复杂,系统对未建模因素敏感,不易实时实现;基于简化模型法解决了实时
步行鲁棒性问题。但是,上述两种方法实现的行走方式属于
2双足机器人模理
假定双足机器人行走平面设定为矢状面澎平面内,机构
静态或准动态行走,当步行过程中出现脚部欠驱动相时[71,不再符合zMP姿态稳定判据的要求。
欠驱动双足机器人的研究给出了一种新的思路,步行过
包括躯干和完全相同的两腿,每条腿有两杆通过膝关节链接而成,膝和髋均为一自由度理想(无摩擦)旋转关节。机器人
步行过程由单腿支撑阶段和双腿支撑阶段组成。
程中单支撑相的支撑域缩为一个点,是完全意义上的动态步
基金项日:国家自然科学基金(the
NationalNatural
ScienceFoundationofChinaunderGrantNo.60905053,No.60574076)。
作者简介:刘成军(1980一),男,博士生,主要研究领域为双足机器人步行控制;李祖枢(1945一),男,教授,博士生导师;厚之成(1987一)。男,硕士
生。E-mail:lcj1@126.com
收稿日期:2011-02.14;修回日期:2011-03.31
万方数据
218
2011,47(24)
ComputerEngineeringandApplications'计算机工程与应用
令吼=吼,q:,鼋,,口JT为机器人的位形相对坐标,吼为躯
干与绝对坐标系z轴的夹角,p。=O。,z。)为躯干质心在绝对坐标系下的位置,譬,=瓯,92,幻吼,吼,‘,磊】T为广义坐标,搿=
阻。,甜:,甜,,材丁为机器人各杆链接处的关节驱动力矩,g=【g,,q:,93,q4,g,为角度向量。如图l所示。
图1双足机器人模型图
双足机器人系统的拉格朗日方程形式为:面d
t吲OK、一蓑+喾锡川,2'…,7
(1)
其中,K为系统的动能,P为系统的势能,a为广义力。
躯干质心和腿末端Pd@矗,z0位置关系可以表示为:
豳=圈+隆翻
c2,
其中,Z锄=魄(鼋),无(g)】T(f=1,2)表示躯干质心和腿末端间
关系的向量函数,由q和双足机器人物理参数共同决定,进而
得到:
删j∥球
(3)
Q*不胃E
㈤
其中,M为双足机器人的质量,爿幻c)为5×5矩阵,一鱼竽
为5x2矩阵,L为4x4单位阵,R,=JR打,R。】T(f=1,2)分别为
两腿末端所受到的地面力。对于双支撑阶段,地面反应力都不为零;对于单支撑阶段其中一个力为零;对于腾空阶段,地
面力都为零。
用分块矩阵表示式(1),机器人的动力学方程表示为:
匮肆+医:净+网=
窿卜札+露R:
(5)
其中,那×5)、D。(2×5)为惯性矩阵,邵×5)、cA2×5)为离
心力和哥氏力矩阵,G、G。为重力项,丑=【0h.;列表示关节
驱动关系,^、‘分别为腿末端作用力R,、R2对应的J∞0bi龇
矩阵。
3实时步态生成
通过对人类步行运动的观察”oI,双足步行是支撑腿与摆动腿交替的重复性动作,在快速行走时,身体经常处于前倾状态,即通过不断打破所谓“稳定”来获得更高的速度。在完成
万方数据
这些动作的过程中,双腿摆动与支撑姿态间的协调变换具有高度的技巧。
3.1步行控制任务的分解
根据步行中摆动腿及支撑腿触地姿态的变化,一个周期内的步行运动过程由四个阶段组成:双支撑相(右腿在前)、右
腿单支撑相、双支撑相(左腿在前)和左腿单支撑相。
步行实时轨迹产生与控制的关键为单支撑相摆动腿与支撑腿的协调运动以及不同相之间的顺利切换,如图2所示。
DSP(Double
Support
Phase)表示机器人处于双支撑相(左腿
或右腿在前),SSP(SmgleSupportPhase)表示机器人处于单支撑相(左腿或右腿单支撑)。
图2双足步行任务分解图
3.2步行姿态生成
通过模仿人类步行的肢体运动特征,结合双足机器人步行要求,实时步行姿态需要满足下列条件。
(1)躯干运动模式
①躯干质心保持在一定高度范围内
双足机器人躯干质心保持在一定高度范围内有利于起步
及摆动腿前移过程中的质心前移。由于质心变换在单支撑相
内较大,因此主要对单支撑相内摆动腿离地和向前摆动两个
阶段进行支撑腿姿态设计,以右腿单支撑相为例,摆动腿为左腿:
左腿离地阶段:93=930一脚。其中,q,o为前一个采样
周期右腿膝关节角值,脚为固定角度,k为系数且k>O。这样可以保证躯干质心仅在较小范围内上移,同时避免高增益反馈,更具有类人行走膝关节的变化特点且实现简单。
左腿向前摆动阶段:q,=盯。此时,右腿膝关节保持为一
个极小的夹角盯,膝关节处也只需要很小的力矩,类似于倒立摆行走,在此过程中双足机器人势能转化为动能,总机械能近似守恒,如图3所示。
图3单支捧栩类似倒立摆
②躯干质心横坐标位于两腿末端横坐标之间
为确保在连续步行中摆动腿沿步行方向运动,躯干质心横坐标必须位于两腿末端横坐标之间。令t,表示右腿末端
横坐标,屹表示左腿末端横坐标,约束关系可以表示为:
刘成军,李祖枢,厚之成:双足机器人动态步行实时步态生成
2011,47(24)
219
Xe2<xg<x训或X引<‘<工蛇
③躯干与绝对坐标系z轴保持固定倾角,则有:吼=%。(2)单支撑相摆动腿动作
在单支撑相,摆动腿动作由左右大腿间夹角确定,左右大腿间夹角变化决定摆动腿继续前摆或伸展落地。以右腿单支撑相为例,令△q=吼一92表示左右大腿间夹角,△go为左右大腿间夹角参考值,可得:
①当却>,aq。时:摆动腿继续前摆。
②当,aq<却。时:摆动腿伸展落地。此时,摆动腿小腿绕膝关节逆时针转动伸展至一定角度开始落地。为保证伸展落地动作的连续性,需满足:
摆动腿小腿运动方向恒定,即满足:讯<0。
摆动腿落地过程中,设定支撑腿膝关节角最小旋转角度值不为零,即满足:q,>O。这保证了机器人Jacobian矩阵的非奇异性及膝关节的柔顺性。
左腿单支撑相摆动腿动作同理可得。
(3)支撑相切换
①双支撑相变为单支撑相
在双支撑相中,以躯干质心与前腿末端X向距离作为相切换标准。当躯干质心靠近前腿超过一定距离时,后腿离地,双支撑相转换为单支撑相。令M=tI一%、△,2=工。一%分别表示躯干质心与前方右支撑腿或后方左支撑腿横坐标间的距
离,则有:
当她<,0时,双支撑相变为右腿单支撑相。当△,,<to时,双支撑相变为左腿单支撑相。
②单支撑相变为双支撑相
在单支撑相中,以躯干质心与支撑腿末端工向距离作为相
切换标准。
当躯干远离支撑腿超过一定距离时,摆动腿落地,单支撑相转换为双支撑相,表示为:
当一611>10'时,右腿单支撑相变为双支撑相。
当Ⅳ,>0时,左腿单支撑相变为双支撑相。
完整步行周期内步态生成的状态切换如图4所示,墨、&
分别表示左右腿末端与地接触隋形。
最=1,最=1
是=1,SK=1
图4完整步行周期内的状态切换
4步行控制
当夹角空间的实时轨迹生成以后,由PD实时位置跟踪控制器实现。地面接触力采用弹簧阻尼模型计算,假设双腿与
万方数据
地接触端各有—个弹簧阻尼模型,依据受力情形,实时检测双腿末端与地面接触情况,作为实时轨迹更新控制和速度调节的开关信号。双足步行过程中,膝关节最小输出角度限制大
于零,当膝关节角低于此最小限定值时,采用PD控制器予以调节,使得膝关节具有一定的柔顺性。
动态步行过程中需要根据实际情况对步行速度施加控制,这可以在单支撑相通过调整左右大腿间夹角差值使得摆动腿落地提前或延后实现。当躯干质心位于支撑腿后方时,摆动腿提前落地可以减慢机器人步行;当躯干质心位于支撑腿前方时,摆动腿落地时间延后可以加快机器人步行。步行
中步长误差与双腿大腿夹角变化共同决定当前速度{Ji|l整。
双足机器人实时步态步行控制框图如图5所示。
图5双足步行实时步态控制框图
5仿真实验
利用Matlab的仿真工具Simulink建立双足机器人步行仿真模型。机器人结构参数如表1所示。
表1机器人结构参数模型参数
躯干
大腿
小腿
质量a,g521长度,m0.80.50.5质心/m
0.4
0.250.25转动惯量/(kg・矗)0.27
O.04
0.02
双足机器人与地面间的接触力采用弹簧阻尼模型计算,
取弹性系数K=10
000
N/m,阻尼系数C=500N・s/m。仿真采
样时间为0.01s。取△g=吼一g:替代92、吼为髋关节控制量,
初始状态表示为删=【g,,q3,却,g,=[o.1,0.22,一0.23,0.053r,
躯干质心P。(0)=(o,1.4)。
步行过程中双足机器人实时生成的轨迹及步行控制结果如图6所示。连续前向动态步行过程中,躯干质心纵坐标z,保持在一定高度范围内,躯干夹角沿实时参考轨迹上下较小幅度波动,这有利于机器人稳定连续步行,如图6(a)、(b)所示;左右腿髋关节夹角及左右膝关节角依照实时产生的轨迹呈协调、交替变化,表明双腿的摆动或支撑动作协调、交替出
现,如图6(c)、(d)所示。实现了双足机器人实时在线轨迹产生与连续动态步行控制目标。
一个完整步行周期内机器人动态步行各阶段姿态如图7所示,步行动画由Matlab/GUI完成。步行开始时双支撑相(右
腿在前)的姿态如图7(a)所示;图7(b)一(d)为右腿单支撑相的
220
2011,47(24)
ComputerEngineeringandApplications计算机工程与应用
翟
、廿
置
荨
以珧t旭
(a)躯干质心轨迹
(b)躯干夹角轨迹(c)髋关节夹角轨迹
f/s以
(d)左膝关节角轨迹
图6连续步行参考轨迹
l8l61412lO昌商O8O6O4020
一0.4—0.2
0x/m
0.2
0.4
一0.4—0.2
0x/m
0.2
0.4
一0.4—0.2Il11l
(e)右膝关节角轨迹
lll1l
#焉
OOOO
口S
;
悖
;
7.
0xlm
0.2
0.4
OO0O
一o.4一o.2o
x/m
o.2o.4
(a)步行初始
l1I11昌赢0O0O
(b)左腿离地
l1l11昌赢OO0O
(c)Yr3退前摆(d)左腿伸展
00.20.4x/m
0.60.800.20.4xlm
0.60.800.20.4xlm
0.60.8
x/m
(c)双腿支撑
(f)右腿离地
(g)右腿前摆
(h)右腿伸展
图7完整步行周期内的运动姿态
姿态,依次表示离地、前摆和伸展阶段;图7(e)为双支撑相结束时的姿态;图7(f)~(h)为右腿单支撑相的姿态,成功实现了动态步行时支撑相的顺序切换。
6结论
本文主要研究了双足机器人动态步行实时步态产生问
(下转232页)
万方数据
232
2011。47(24)
ComputerEngineeringandApplications计算机工程与应用
之栅巅恃棼卅需疑
M3
f一定,0随A变化曲线图图4,一定。Ⅳ随^变化曲线图
A的取值问题,找出实际系统最适合的A,以避免由于A的取值不当而导致浮动车的投入与产出失调。4结束语
在考虑了采样时间间隔、浮动车运行速度、通信效率以及
误匹配率等因素的基础上,重点考虑了浮动车的混合情况,分
术阴.计算机应用研究,2007,2:243.245.
【5】王力,王川久,沈晓蓉,等.智能交通系统中实时交通信息采集处理
的新方法们.系统工程,2005,23(2):86.89.
【6】Quiroga
el
CA。Bullock
D.Determinationof
samplesizesfortray-
time
s删es[j].ITE
to
Journal,1998,68(8):92-98.
timedata
【7】QiY,Smith
of
a
BL.Travel
quarry锻嘲锄ent:development
U'afficmonitoring
析了混合比例系数对浮动车样本数量的影响,建立了面向道路网的浮动车样本数量计算模型。仿真结果表明:本文模型与前人模型相比,实际应用能力得到增强。但本文模型还存在一些不足之处,例如只考虑了公交车和出租车的混合,没有考虑公交车对路网的覆盖能力,以及公交专用道对混合车流的影响,在下—步的研究中,将对模型作进—步的改进和完善。
design
testnfwgeneration
systms[c]#
detectors?
of
84thAnnualMeetingTransportationResearchBoard.2005.
【8】Kwon
Effect
J,Petty
K,VaraiyaEProbe
spacingand
vehicle
n咖or
on
loopthe
of
de忱咖r
congestion
samplesize
accuracy
freeway
monitoring[C]//86th
Annual
MeetingTraus-
portation矗∞of
probe
ResearchBoard,2007.
R.Short
【9】VanajakahiL,SubramaaianSC,Sivanandan
termpredic-
参考文献:
【l】涂智,李昊,姚琛,等.基于最小浮动车样本数量的道路覆盖率与交
通信息更新周期研究[J】.中国铁道科学,2006,27(5):127.131.【2】姚琛.基于路段覆盖率的浮动车样本数量研究叨.山东理工大学学
报,2006,20(3):96-98.
【3】张存保,杨晓光,严新平.移动交通检测系统中探测车的样本数量【J】.
中国公路学报,2007,20(1):96.101.
traveltimefor
Indiantrafficconditionsusingbuses鹤
Annual
vehicles}[C],/87th
MeetingTransportationResearch
Board,2008.
【10】林思,徐建闽,熊文华.基于仿真试验的GPS浮动车最佳榉本容量
确定方法研究叨.交通与计算机,2008,26(4):72.74.
【1l】钟永艳.公交专用道的影响分析[D】.四川:西南交通大学,2008.【12】韩慧敏.出租车在公交专用道上行驶的可行性研究【D】.北京:北京
交通大学,2007.
【4】孙棣华,董均宇,廖孝勇.基于GPS探测车的道路交通状态估计技
(上接220页)
题,在分析平面五杆双足机器人动力学模型的基础上,将动态步行复杂控制任务分解为顺序执行的四个过程,模仿人类步行主要运动特征,设计了双足机器人在线产生关节轨迹模式,并结合当前控制结果实时更新。仿真结果表明,该方法实现了双足机器人连续动态步行,简单易实现,对实现大步幅快速步行、动态跑步等具有一定的借鉴作用。
fion
parametersbB8cd
inwmed
l∞ndulm
trajectorygem-r..or[J].
Robotics
andAutonomousSystems,2008,56:738-750.W,Kim
J
【5】Park
I
Y,Oh
to
a
JH.Onlinewalkingpatternbiped
humanoid
andits
application
generation
robot-KHR-3(HU-
BO)[J】.Advanced
Robotics,2008,22:159-190.
F,m
【6】LaffierK,GiengerM,Pfeiffer
cept
of
a
a1.Sensorsandcontrol
on
COn-
biped
robot[J].IEEETransactions
IndustrialElec・
tronics,2004,51(5):972・980.
参考文献:
【l】LimH,OgumY,TakaniahiA.I.,ocomotioa
mechanisms
of
a
【刀付成龙,陈恳.五杆四驱动平面双足机器人动态步态规划与非线性
pattern
generationand
RSocA,
控制【J】.机器人,2006,28(2):206-212.
【8】Grizzle
J
new
biped
walking
machine叨.Proc
W,AbbaG,PlestanF.Asymptotically
robots:analysbviasystems
On
stable
walking
2008.464:273-288.
forbiped
IEEE
withimpulseeffects[J].
【2】Wieber
jectories
PB,C'hevallereaaforthecontrolof
C.Online
adaptation
ofreferencetra-
TransactionsAutomaticControl,2001,46(1):51-64.
walkingsystems[J].RoboticsandAu-
【91
Chevallereau
C。Gri2zlcJW。ShillCL.Asymptoticallystablewalk-
tonomousSystems,2006,54:559-566.【3】KajitaS,Kanehiro
elationby
a
ingof
afive・link
underact阻ted
3-D
bipedal
robot[J].IEEE
Trans-
F。KanekoK,eta1.Bipedwalkingpattern
simple
tla've-dimeusienalinverted
p训tlmmodel[J].
gen-
actionsOn
Robotics,2009,25(1):37.50.
J
H,CusmnanoJ
P,n
[10】Jordan
K,Challis
a1.Stabilityandthe
run-
AdvancedRobotics,2003。17(2):131・147.
[41
Vm血:rb碘B。Vermeulan
time-flepcndeatm'uctm'eofgaitvariabilityinw“kingand
J,HamRV,cta1.Objectiveloe.,omo-
ning[f1.HumanMovementScience,2009,28(1):113-128.
万方数据
双足机器人动态步行实时步态生成
作者:作者单位:刊名:英文刊名:年,卷(期):
刘成军, 李祖枢, 厚之成, LIU Chengjun, LI Zushu, HOU Zhicheng
刘成军,厚之成,LIU Chengjun,HOU Zhicheng(重庆大学智能自动化研究所,重庆,400044), 李祖枢,LIZushu(重庆大学智能自动化研究所,重庆400044;重庆理工大学计算机科学与工程学院,重庆400050)计算机工程与应用
Computer Engineering and Applications2011,47(24)
1.Lim H;Ogura Y;Takanishi A Locomotion pattern generation and mechanisms of a new biped walking machine 20082.Wieber P B;Chevallereau C Online adaptation of reference trajectories for the control of walking systems[外文期刊] 2006(7)
3.Kajita S;Kanehiro F;Kaneko K Biped walking pattern generation by a simple three-dimensional inverted pendulummodel[外文期刊] 2003(02)
4.Vanderborght B;Vermeulen J;Ham R V;et el Objective locomotion parameters besed inverted pendulum trajectorygenerator[外文期刊] 2008(9)
5.Park I W;Kim J Y;Oh J H Online walking pattern generation and its application to a biped humanoid robot-KHR-3(HUBO)[外文期刊] 2008
6.L(o)ffler K;Gienger M;Pfeiffer F Sensors and control concept of a biped robot[外文期刊] 2004(05)7.付成龙;陈恳 五杆四驱动平面双足机器人动态步态规划与非线性 控制[期刊论文]-机器人 2006(02)
8.Grizzle J W;Abba G;Plestan F Asymptotically stable walking for biped robots:analysis via systems with impulseeffects[外文期刊] 2001(01)
9.Chevallereau C;Grizzle J W;Shih C L Asymptotically stable walking of a five-link underactuated 3-D bipedal robot[外文期刊] 2009(01)
10.Jordan K;Challis J H;Cusumano J P Stability and the time-dependent structure of gait variabifity in walking andrumning[外文期刊] 2009(01)
本文链接:http://d.g.wanfangdata.com.cn/Periodical_jsjgcyyy201124061.aspx
ComputerEngineering
andApplications计算机工程与应用
2011,47(24)
217
双足机器人动态步行实时步态生成
刘成军1,李祖枢“2,厚之成1
LIU
Chengjunl,LIZushu“2,HOUZhichen91
1.重庆大学智能自动化研究所,重庆400044
2.重庆理工大学计算机科学与工程学院,重庆400050
l-InstituteofIntelligentAutomation,Chongqing2.CoUegeofComputer
Scienceand
University,Chongqing
400044,China
Engineering,ChongqingUniversityofTechnology,Chongqing400050,China
LIU
Chengjun.LI
Zushu.HOUZhieheng.Online
locomotion
patterngeneration
ofdynamicwalking
for
biped
roboL
ComputerEngineeringandApplications。2011.47(24):217・220.
Abstract:Asimpleandintuitiveschemeaboutonlinelocomotionpatterngenerationofdynamicwalkingforbipedrobotis
complex
presented
divided
to
solvethe
jointtrajectory
to
design.The
dynamicsmodelof
a
five・link
of
planarbipedrobotiswalking
for
established.
robotis
Byimitatingthe
byfour
main
characteristics
ofhumanwalking
motion,the
complexprocess
dynamic
biped
sequence
phasesaccording
therequirementsoftheposturechangeoflegsfordynamicwalking.Theloco・
ale
motionpatternoftnmk,themovementofswinglegandsupportleg,themethodofwalkingspeedadjustment
designed
jointanglespace.Thestablejointtrajectoryisgeneratedwithonlinefeedbackcontr01.Simulationtivenessoftheproposedmethodwhichissimpleandeasytoberealized.
inthe
resultshowstheeffec-
Keywords:bipedrobot;dynamicwalking;loeomotion
pattern
generation;control
systems
摘要:针对双足机器人动态步行生成关节运动轨迹复杂问题,提出了一种简单直观的实时步态生成方案。建立了平面五杆双
足机器人动力学模型,通过模仿人类步行主要运动特征并根据双足机器人动态步行双腿姿态变化的要求,将动态步行复杂任务分解为顺序执行的四个过程,在关节空间相对坐标系下设计了躯干运动模式、摆动腿和支撑腿动作及步行速度调整模式,结合当前步行控制结果反馈实时产生稳定的关节运动轨迹。仿真实验验证了该方法的有效性,简单易实现。
关键词:双足机器人;动态步行;步态生成;控制系统DOI:10.377S/j.issn.1002.8331.2011.24.061
文章编号:1002.8331(2011)24.0217.04
文献标识码:A
中图分类号:TP242.6
1引言
双足机器人具有与人类相似的步行运动方式,可以通过狭窄空间、跨越障碍、上下台阶和斜坡,甚至在不平整地面上运动,更适合在人类的生活或工作环境中工作。双足机器人稳
定、快速、自然的步行,对协助人类、与人合作具有重要的意义。
目前,双足机器人步行研究大多把ZMP(ZeroMomentPoint)稳定判据作为步行轨迹产生的基础,基于精确系统模
行机器人。一种步行轨迹产生的方法是基于Poincar6回归映射将步行运动规划为一个完整的虚拟约束㈣。但由于获得
Poinear6映射理论方法的困难性和数值方法计算的复杂性,其
应用仍具有很大的局限性。另外一种方法是基于约束方程产生步行运动轨迹,求解结果是否满足步态的可重复性不直观。本文在分析双足机器人动力学模型的基础上,模仿人类步行
主要运动特征,提出在关节空间相对坐标系下设计躯干运动
型“。21或简化模型如倒立摆模型n卅在绝对坐标系下产生步行轨
迹,求逆计算关节角空问轨迹。基于精确系统模型的方法可
模式、摆动腿和支撑腿动作及步行速度调整模式,结合当前步行控制结果反馈实时产生稳定的关节运动轨迹,并通过仿真实验验证了该方法的有效性,简单易实现。
获得满足ZMP轨迹的确切步行解,但轨迹产生较复杂,系统对未建模因素敏感,不易实时实现;基于简化模型法解决了实时
步行鲁棒性问题。但是,上述两种方法实现的行走方式属于
2双足机器人模理
假定双足机器人行走平面设定为矢状面澎平面内,机构
静态或准动态行走,当步行过程中出现脚部欠驱动相时[71,不再符合zMP姿态稳定判据的要求。
欠驱动双足机器人的研究给出了一种新的思路,步行过
包括躯干和完全相同的两腿,每条腿有两杆通过膝关节链接而成,膝和髋均为一自由度理想(无摩擦)旋转关节。机器人
步行过程由单腿支撑阶段和双腿支撑阶段组成。
程中单支撑相的支撑域缩为一个点,是完全意义上的动态步
基金项日:国家自然科学基金(the
NationalNatural
ScienceFoundationofChinaunderGrantNo.60905053,No.60574076)。
作者简介:刘成军(1980一),男,博士生,主要研究领域为双足机器人步行控制;李祖枢(1945一),男,教授,博士生导师;厚之成(1987一)。男,硕士
生。E-mail:lcj1@126.com
收稿日期:2011-02.14;修回日期:2011-03.31
万方数据
218
2011,47(24)
ComputerEngineeringandApplications'计算机工程与应用
令吼=吼,q:,鼋,,口JT为机器人的位形相对坐标,吼为躯
干与绝对坐标系z轴的夹角,p。=O。,z。)为躯干质心在绝对坐标系下的位置,譬,=瓯,92,幻吼,吼,‘,磊】T为广义坐标,搿=
阻。,甜:,甜,,材丁为机器人各杆链接处的关节驱动力矩,g=【g,,q:,93,q4,g,为角度向量。如图l所示。
图1双足机器人模型图
双足机器人系统的拉格朗日方程形式为:面d
t吲OK、一蓑+喾锡川,2'…,7
(1)
其中,K为系统的动能,P为系统的势能,a为广义力。
躯干质心和腿末端Pd@矗,z0位置关系可以表示为:
豳=圈+隆翻
c2,
其中,Z锄=魄(鼋),无(g)】T(f=1,2)表示躯干质心和腿末端间
关系的向量函数,由q和双足机器人物理参数共同决定,进而
得到:
删j∥球
(3)
Q*不胃E
㈤
其中,M为双足机器人的质量,爿幻c)为5×5矩阵,一鱼竽
为5x2矩阵,L为4x4单位阵,R,=JR打,R。】T(f=1,2)分别为
两腿末端所受到的地面力。对于双支撑阶段,地面反应力都不为零;对于单支撑阶段其中一个力为零;对于腾空阶段,地
面力都为零。
用分块矩阵表示式(1),机器人的动力学方程表示为:
匮肆+医:净+网=
窿卜札+露R:
(5)
其中,那×5)、D。(2×5)为惯性矩阵,邵×5)、cA2×5)为离
心力和哥氏力矩阵,G、G。为重力项,丑=【0h.;列表示关节
驱动关系,^、‘分别为腿末端作用力R,、R2对应的J∞0bi龇
矩阵。
3实时步态生成
通过对人类步行运动的观察”oI,双足步行是支撑腿与摆动腿交替的重复性动作,在快速行走时,身体经常处于前倾状态,即通过不断打破所谓“稳定”来获得更高的速度。在完成
万方数据
这些动作的过程中,双腿摆动与支撑姿态间的协调变换具有高度的技巧。
3.1步行控制任务的分解
根据步行中摆动腿及支撑腿触地姿态的变化,一个周期内的步行运动过程由四个阶段组成:双支撑相(右腿在前)、右
腿单支撑相、双支撑相(左腿在前)和左腿单支撑相。
步行实时轨迹产生与控制的关键为单支撑相摆动腿与支撑腿的协调运动以及不同相之间的顺利切换,如图2所示。
DSP(Double
Support
Phase)表示机器人处于双支撑相(左腿
或右腿在前),SSP(SmgleSupportPhase)表示机器人处于单支撑相(左腿或右腿单支撑)。
图2双足步行任务分解图
3.2步行姿态生成
通过模仿人类步行的肢体运动特征,结合双足机器人步行要求,实时步行姿态需要满足下列条件。
(1)躯干运动模式
①躯干质心保持在一定高度范围内
双足机器人躯干质心保持在一定高度范围内有利于起步
及摆动腿前移过程中的质心前移。由于质心变换在单支撑相
内较大,因此主要对单支撑相内摆动腿离地和向前摆动两个
阶段进行支撑腿姿态设计,以右腿单支撑相为例,摆动腿为左腿:
左腿离地阶段:93=930一脚。其中,q,o为前一个采样
周期右腿膝关节角值,脚为固定角度,k为系数且k>O。这样可以保证躯干质心仅在较小范围内上移,同时避免高增益反馈,更具有类人行走膝关节的变化特点且实现简单。
左腿向前摆动阶段:q,=盯。此时,右腿膝关节保持为一
个极小的夹角盯,膝关节处也只需要很小的力矩,类似于倒立摆行走,在此过程中双足机器人势能转化为动能,总机械能近似守恒,如图3所示。
图3单支捧栩类似倒立摆
②躯干质心横坐标位于两腿末端横坐标之间
为确保在连续步行中摆动腿沿步行方向运动,躯干质心横坐标必须位于两腿末端横坐标之间。令t,表示右腿末端
横坐标,屹表示左腿末端横坐标,约束关系可以表示为:
刘成军,李祖枢,厚之成:双足机器人动态步行实时步态生成
2011,47(24)
219
Xe2<xg<x训或X引<‘<工蛇
③躯干与绝对坐标系z轴保持固定倾角,则有:吼=%。(2)单支撑相摆动腿动作
在单支撑相,摆动腿动作由左右大腿间夹角确定,左右大腿间夹角变化决定摆动腿继续前摆或伸展落地。以右腿单支撑相为例,令△q=吼一92表示左右大腿间夹角,△go为左右大腿间夹角参考值,可得:
①当却>,aq。时:摆动腿继续前摆。
②当,aq<却。时:摆动腿伸展落地。此时,摆动腿小腿绕膝关节逆时针转动伸展至一定角度开始落地。为保证伸展落地动作的连续性,需满足:
摆动腿小腿运动方向恒定,即满足:讯<0。
摆动腿落地过程中,设定支撑腿膝关节角最小旋转角度值不为零,即满足:q,>O。这保证了机器人Jacobian矩阵的非奇异性及膝关节的柔顺性。
左腿单支撑相摆动腿动作同理可得。
(3)支撑相切换
①双支撑相变为单支撑相
在双支撑相中,以躯干质心与前腿末端X向距离作为相切换标准。当躯干质心靠近前腿超过一定距离时,后腿离地,双支撑相转换为单支撑相。令M=tI一%、△,2=工。一%分别表示躯干质心与前方右支撑腿或后方左支撑腿横坐标间的距
离,则有:
当她<,0时,双支撑相变为右腿单支撑相。当△,,<to时,双支撑相变为左腿单支撑相。
②单支撑相变为双支撑相
在单支撑相中,以躯干质心与支撑腿末端工向距离作为相
切换标准。
当躯干远离支撑腿超过一定距离时,摆动腿落地,单支撑相转换为双支撑相,表示为:
当一611>10'时,右腿单支撑相变为双支撑相。
当Ⅳ,>0时,左腿单支撑相变为双支撑相。
完整步行周期内步态生成的状态切换如图4所示,墨、&
分别表示左右腿末端与地接触隋形。
最=1,最=1
是=1,SK=1
图4完整步行周期内的状态切换
4步行控制
当夹角空间的实时轨迹生成以后,由PD实时位置跟踪控制器实现。地面接触力采用弹簧阻尼模型计算,假设双腿与
万方数据
地接触端各有—个弹簧阻尼模型,依据受力情形,实时检测双腿末端与地面接触情况,作为实时轨迹更新控制和速度调节的开关信号。双足步行过程中,膝关节最小输出角度限制大
于零,当膝关节角低于此最小限定值时,采用PD控制器予以调节,使得膝关节具有一定的柔顺性。
动态步行过程中需要根据实际情况对步行速度施加控制,这可以在单支撑相通过调整左右大腿间夹角差值使得摆动腿落地提前或延后实现。当躯干质心位于支撑腿后方时,摆动腿提前落地可以减慢机器人步行;当躯干质心位于支撑腿前方时,摆动腿落地时间延后可以加快机器人步行。步行
中步长误差与双腿大腿夹角变化共同决定当前速度{Ji|l整。
双足机器人实时步态步行控制框图如图5所示。
图5双足步行实时步态控制框图
5仿真实验
利用Matlab的仿真工具Simulink建立双足机器人步行仿真模型。机器人结构参数如表1所示。
表1机器人结构参数模型参数
躯干
大腿
小腿
质量a,g521长度,m0.80.50.5质心/m
0.4
0.250.25转动惯量/(kg・矗)0.27
O.04
0.02
双足机器人与地面间的接触力采用弹簧阻尼模型计算,
取弹性系数K=10
000
N/m,阻尼系数C=500N・s/m。仿真采
样时间为0.01s。取△g=吼一g:替代92、吼为髋关节控制量,
初始状态表示为删=【g,,q3,却,g,=[o.1,0.22,一0.23,0.053r,
躯干质心P。(0)=(o,1.4)。
步行过程中双足机器人实时生成的轨迹及步行控制结果如图6所示。连续前向动态步行过程中,躯干质心纵坐标z,保持在一定高度范围内,躯干夹角沿实时参考轨迹上下较小幅度波动,这有利于机器人稳定连续步行,如图6(a)、(b)所示;左右腿髋关节夹角及左右膝关节角依照实时产生的轨迹呈协调、交替变化,表明双腿的摆动或支撑动作协调、交替出
现,如图6(c)、(d)所示。实现了双足机器人实时在线轨迹产生与连续动态步行控制目标。
一个完整步行周期内机器人动态步行各阶段姿态如图7所示,步行动画由Matlab/GUI完成。步行开始时双支撑相(右
腿在前)的姿态如图7(a)所示;图7(b)一(d)为右腿单支撑相的
220
2011,47(24)
ComputerEngineeringandApplications计算机工程与应用
翟
、廿
置
荨
以珧t旭
(a)躯干质心轨迹
(b)躯干夹角轨迹(c)髋关节夹角轨迹
f/s以
(d)左膝关节角轨迹
图6连续步行参考轨迹
l8l61412lO昌商O8O6O4020
一0.4—0.2
0x/m
0.2
0.4
一0.4—0.2
0x/m
0.2
0.4
一0.4—0.2Il11l
(e)右膝关节角轨迹
lll1l
#焉
OOOO
口S
;
悖
;
7.
0xlm
0.2
0.4
OO0O
一o.4一o.2o
x/m
o.2o.4
(a)步行初始
l1I11昌赢0O0O
(b)左腿离地
l1l11昌赢OO0O
(c)Yr3退前摆(d)左腿伸展
00.20.4x/m
0.60.800.20.4xlm
0.60.800.20.4xlm
0.60.8
x/m
(c)双腿支撑
(f)右腿离地
(g)右腿前摆
(h)右腿伸展
图7完整步行周期内的运动姿态
姿态,依次表示离地、前摆和伸展阶段;图7(e)为双支撑相结束时的姿态;图7(f)~(h)为右腿单支撑相的姿态,成功实现了动态步行时支撑相的顺序切换。
6结论
本文主要研究了双足机器人动态步行实时步态产生问
(下转232页)
万方数据
232
2011。47(24)
ComputerEngineeringandApplications计算机工程与应用
之栅巅恃棼卅需疑
M3
f一定,0随A变化曲线图图4,一定。Ⅳ随^变化曲线图
A的取值问题,找出实际系统最适合的A,以避免由于A的取值不当而导致浮动车的投入与产出失调。4结束语
在考虑了采样时间间隔、浮动车运行速度、通信效率以及
误匹配率等因素的基础上,重点考虑了浮动车的混合情况,分
术阴.计算机应用研究,2007,2:243.245.
【5】王力,王川久,沈晓蓉,等.智能交通系统中实时交通信息采集处理
的新方法们.系统工程,2005,23(2):86.89.
【6】Quiroga
el
CA。Bullock
D.Determinationof
samplesizesfortray-
time
s删es[j].ITE
to
Journal,1998,68(8):92-98.
timedata
【7】QiY,Smith
of
a
BL.Travel
quarry锻嘲锄ent:development
U'afficmonitoring
析了混合比例系数对浮动车样本数量的影响,建立了面向道路网的浮动车样本数量计算模型。仿真结果表明:本文模型与前人模型相比,实际应用能力得到增强。但本文模型还存在一些不足之处,例如只考虑了公交车和出租车的混合,没有考虑公交车对路网的覆盖能力,以及公交专用道对混合车流的影响,在下—步的研究中,将对模型作进—步的改进和完善。
design
testnfwgeneration
systms[c]#
detectors?
of
84thAnnualMeetingTransportationResearchBoard.2005.
【8】Kwon
Effect
J,Petty
K,VaraiyaEProbe
spacingand
vehicle
n咖or
on
loopthe
of
de忱咖r
congestion
samplesize
accuracy
freeway
monitoring[C]//86th
Annual
MeetingTraus-
portation矗∞of
probe
ResearchBoard,2007.
R.Short
【9】VanajakahiL,SubramaaianSC,Sivanandan
termpredic-
参考文献:
【l】涂智,李昊,姚琛,等.基于最小浮动车样本数量的道路覆盖率与交
通信息更新周期研究[J】.中国铁道科学,2006,27(5):127.131.【2】姚琛.基于路段覆盖率的浮动车样本数量研究叨.山东理工大学学
报,2006,20(3):96-98.
【3】张存保,杨晓光,严新平.移动交通检测系统中探测车的样本数量【J】.
中国公路学报,2007,20(1):96.101.
traveltimefor
Indiantrafficconditionsusingbuses鹤
Annual
vehicles}[C],/87th
MeetingTransportationResearch
Board,2008.
【10】林思,徐建闽,熊文华.基于仿真试验的GPS浮动车最佳榉本容量
确定方法研究叨.交通与计算机,2008,26(4):72.74.
【1l】钟永艳.公交专用道的影响分析[D】.四川:西南交通大学,2008.【12】韩慧敏.出租车在公交专用道上行驶的可行性研究【D】.北京:北京
交通大学,2007.
【4】孙棣华,董均宇,廖孝勇.基于GPS探测车的道路交通状态估计技
(上接220页)
题,在分析平面五杆双足机器人动力学模型的基础上,将动态步行复杂控制任务分解为顺序执行的四个过程,模仿人类步行主要运动特征,设计了双足机器人在线产生关节轨迹模式,并结合当前控制结果实时更新。仿真结果表明,该方法实现了双足机器人连续动态步行,简单易实现,对实现大步幅快速步行、动态跑步等具有一定的借鉴作用。
fion
parametersbB8cd
inwmed
l∞ndulm
trajectorygem-r..or[J].
Robotics
andAutonomousSystems,2008,56:738-750.W,Kim
J
【5】Park
I
Y,Oh
to
a
JH.Onlinewalkingpatternbiped
humanoid
andits
application
generation
robot-KHR-3(HU-
BO)[J】.Advanced
Robotics,2008,22:159-190.
F,m
【6】LaffierK,GiengerM,Pfeiffer
cept
of
a
a1.Sensorsandcontrol
on
COn-
biped
robot[J].IEEETransactions
IndustrialElec・
tronics,2004,51(5):972・980.
参考文献:
【l】LimH,OgumY,TakaniahiA.I.,ocomotioa
mechanisms
of
a
【刀付成龙,陈恳.五杆四驱动平面双足机器人动态步态规划与非线性
pattern
generationand
RSocA,
控制【J】.机器人,2006,28(2):206-212.
【8】Grizzle
J
new
biped
walking
machine叨.Proc
W,AbbaG,PlestanF.Asymptotically
robots:analysbviasystems
On
stable
walking
2008.464:273-288.
forbiped
IEEE
withimpulseeffects[J].
【2】Wieber
jectories
PB,C'hevallereaaforthecontrolof
C.Online
adaptation
ofreferencetra-
TransactionsAutomaticControl,2001,46(1):51-64.
walkingsystems[J].RoboticsandAu-
【91
Chevallereau
C。Gri2zlcJW。ShillCL.Asymptoticallystablewalk-
tonomousSystems,2006,54:559-566.【3】KajitaS,Kanehiro
elationby
a
ingof
afive・link
underact阻ted
3-D
bipedal
robot[J].IEEE
Trans-
F。KanekoK,eta1.Bipedwalkingpattern
simple
tla've-dimeusienalinverted
p训tlmmodel[J].
gen-
actionsOn
Robotics,2009,25(1):37.50.
J
H,CusmnanoJ
P,n
[10】Jordan
K,Challis
a1.Stabilityandthe
run-
AdvancedRobotics,2003。17(2):131・147.
[41
Vm血:rb碘B。Vermeulan
time-flepcndeatm'uctm'eofgaitvariabilityinw“kingand
J,HamRV,cta1.Objectiveloe.,omo-
ning[f1.HumanMovementScience,2009,28(1):113-128.
万方数据
双足机器人动态步行实时步态生成
作者:作者单位:刊名:英文刊名:年,卷(期):
刘成军, 李祖枢, 厚之成, LIU Chengjun, LI Zushu, HOU Zhicheng
刘成军,厚之成,LIU Chengjun,HOU Zhicheng(重庆大学智能自动化研究所,重庆,400044), 李祖枢,LIZushu(重庆大学智能自动化研究所,重庆400044;重庆理工大学计算机科学与工程学院,重庆400050)计算机工程与应用
Computer Engineering and Applications2011,47(24)
1.Lim H;Ogura Y;Takanishi A Locomotion pattern generation and mechanisms of a new biped walking machine 20082.Wieber P B;Chevallereau C Online adaptation of reference trajectories for the control of walking systems[外文期刊] 2006(7)
3.Kajita S;Kanehiro F;Kaneko K Biped walking pattern generation by a simple three-dimensional inverted pendulummodel[外文期刊] 2003(02)
4.Vanderborght B;Vermeulen J;Ham R V;et el Objective locomotion parameters besed inverted pendulum trajectorygenerator[外文期刊] 2008(9)
5.Park I W;Kim J Y;Oh J H Online walking pattern generation and its application to a biped humanoid robot-KHR-3(HUBO)[外文期刊] 2008
6.L(o)ffler K;Gienger M;Pfeiffer F Sensors and control concept of a biped robot[外文期刊] 2004(05)7.付成龙;陈恳 五杆四驱动平面双足机器人动态步态规划与非线性 控制[期刊论文]-机器人 2006(02)
8.Grizzle J W;Abba G;Plestan F Asymptotically stable walking for biped robots:analysis via systems with impulseeffects[外文期刊] 2001(01)
9.Chevallereau C;Grizzle J W;Shih C L Asymptotically stable walking of a five-link underactuated 3-D bipedal robot[外文期刊] 2009(01)
10.Jordan K;Challis J H;Cusumano J P Stability and the time-dependent structure of gait variabifity in walking andrumning[外文期刊] 2009(01)
本文链接:http://d.g.wanfangdata.com.cn/Periodical_jsjgcyyy201124061.aspx