一个四足机器人步态计划和模拟修正基于轨迹的关键点.docVIP

基于轨迹关键点的四足机器人步态规划与仿真 　韩晓建，刘广超，丁相方，刘溢 （北京航空航天大学 机械工程及自动化学院，北京 100191） 摘要：为了探索高效、合理的四足机器人步态规划方法，保证机器人稳定的行走，利用关键点描述足底运动轨迹，以满足机器人运动参数和结构化环境的要求，同时，结合机器人运动学模型求得关节关键角度集合，并运用三次样条插值得到关节运动函数，进而实现计算机虚拟样机的仿真。仿真结果证明，该步态规划方法得到的关节运动函数能够使得四足机器人实现15个周期以上的稳定和连续运动，验证了该方法的正确性。 关键词：四足机器人；关键点； 步态规划；仿真 中图分类号：TP242　　文献标识码：A 　　文章编号: 四足机器人结构相对简单，保持稳定运动的能力较好，步态控制复杂程度适中，且承载能力和对不平地形的适应能力较强，在足式机器人研究领域颇受重视，率先实用化的可能性最高，在核设备检修、排爆、探险、山区运输、矿山开采、教育、娱乐等方面的应用前景非常好[1]。四足机器人各腿部协调运动的规律被称为步态[2]，而获得步态的过程即为步态规划。步态规划是一个根据外界环境和自身条件确定整体运动、腿部运动以及关节规律之间关系的过程，对于四足机器人，其步态规划是运动控制的重要内容，是国内外学者研究的重点[3]。 目前，四足机器人步态规划的常用方法为基于模型的方法，即根据不同四足机器人的运动模型，由足底轨迹计算得到关节角度变化函数[4]。该方法中，考虑机器人运动的稳定性和可靠性，足底轨迹运动形式的选择较为关键。王立鹏等[5]采用复合摆线作为摆动相足底轨迹，规划得到的步态实现了足底与地面接触零冲击；荣学文等[6]使用多项式描述足底运动轨迹，规划所得步态使得四足机器人实物样机实现了连续行走，且足底冲击小，机体稳定性好；蓝益鹏等[7]通过椭圆足底轨迹得到了机器人对角运动步态，且满足实际样机行走需求。上述足底轨迹表达方法都使用了连续的曲线，有具体的函数表达式，能够满足步态规划需求，但繁琐的函数表达式增大了计算负担，降低了计算效率，且每种函数描述的轨迹形状较为固定，很难适应多种结构化的地形环境。 * 收稿日期: 2014-05-08作者简介：韩晓建( * 收稿日期: 2014-05-08 作者简介：韩晓建(1963—)，男，湖北红安人，副教授，博士，目前从事机器人技术研究，已发表论文22篇 四足机器人步态运动机理 四足机器人步态的研究开始于模仿，所谓模仿就是指对四足动物身体尺寸比例、运动特性、运动系统组成等多方面的模仿，适当的模仿有效降低了研究工作的难度，增加成功的可能性[8]。仔细观察动物的行走运动，可以发现动物的各腿部之间一般保持固定的相位关系，以对角步态为例，当一组对角腿部处于摆动相时，另外一组对角腿部处于支撑相，每一个步态周期中每条腿均是完全遍历一个摆动相和一个支撑相时间，周而复始。如图1所示，LF、RF、RR、LR分别代表四足动物的左前腿、右前腿、右后腿、左后腿，黑色的方格代表落地，即支撑相，白色的方格代表悬空，即摆动相。进入第一个步态周期，当LF和RR处于支撑相时，另外一组对角腿LR、RF处于摆动相，此为半个周期，然后，当LF和RR处于摆动相时，另外一组对角腿LR、RF处于支撑相，至此，结束一个步态周期，接下来进行周期性循环。四足机器人的对角步态运动模仿四足动物，也将经历图1所示的运动过程。 图1 四足动物对角步态运动机理 轨迹关键点 摆动相轨迹关键点描述 摆动相的足底运动轨迹的选择对于四足机器人的步态规划是至关重要的，目前，多数四足机器人采用连续的足底轨迹，有明确的数学函数表达式，增加了计算的复杂程度，且当面临不同的结构化地形时，不同的足底轨迹函数的形状单一，往往无法满足目标物和障碍物外形轮廓要求，缺乏普遍的适应性。所以，本文使用运动轨迹上的关键点代替一般的连续运动函数。 关键点的数量取决于结构化的地形以及整体运动参数的要求。首先，考虑步态基本参数要求，足底关键点必须能够确定机器人运动步长（单周期运动距离），故关键点包括起始点和终止点，确定抬起腿和放下腿的位置；其次，为了定义抬腿高度（摆动相抬腿最大离地高度），定义最高点；最后，为了保证足底运动轮廓，定义一些中间点，数量可根据具体情况而定，最少两个。所以，最少需要5个关键点来描述摆动相足底运动轨迹，以平面坐标表达关键点位置，坐标系定义如图2所示，设以足底与地面接触点为坐标原点的坐标系为XOboY，以髋部中心为坐标原点的坐标系为x0O0z0，髋部、大腿、小腿长度分别为l1=0.145m、l2=0.42m、l3=0.505m。设机器人的步态参数如表1所示，其中，sh为步长的四分之一，则根据关键点的选取过程，计算得到表2所示的机器人5个摆动相足底轨迹关键点在XOboY坐标系下的坐标，t代表运动