北航adams实验报告-四足机器人

成绩

采用ADAMS和MATLAB建立机械装置或机电装置虚拟样机

——四足机器人建模与仿真

实验报告

院（系）名称自动化科学与电气工程

专业名称控制工程

学生学号0

学生姓名0

指导教师0

2016年4月

一、实验背景

1. 参照自然界四足哺乳动物如猫狗的运动形式，对四足机器人进行建模，结合虚拟样机技术软件ADAMS，对四足机器人进行步态规划、运动学和动力学分析，使四足机器人模型良好运行。

2. 利用拉格朗日能量法建立四足机器人坐标系并对四足机器人进行运动学分析。

3.在Solidworks中建立四足机器人三维模型，之后将三维模型导入至虚拟样机软件ADAMS中，在ADAMS中建立虚拟样机模型，并利用样条曲线来规划机器人的运动轨迹，进行仿真，实现机器人的直线行走。

二、实验原理

2.1 研究对象背景分析

移动机器人按移动方式大体分为两大类；一是由现代车辆技术延伸发展成轮式移动机器人（包括履带式）；二是基于仿生技术的运动仿生机器人。运动仿生机器人按移动方式分为足式移动、蠕动、蛇行、游动及扑翼飞行等形式,其中足式机器人是研究最多的一类运动仿生机器人。

自然环境中有约50％的地形，轮式或履带式车辆到达不了，而这些地方如森林，草地湿地，山林地等地域中拥有巨大的资源，要探测和利用且要尽可能少的破坏环境，足式机器人以其固有的移动优势成为野外探测工作的首选，另外，如海底和极地的科学考察和探索，足式机器人也具有明显的优势，因而足式机器人的研究得到世界各国的广泛重视。现研制成功的足式机器人有1足，2足，4足，6足，8足等系列，大于8足的研究很少。

曾长期作为人类主要交通工具的马，牛，驴，骆驼等四足动物因其优越的野外行走能力和负载能力自然是人们研究足式机器人的重点仿生对象。因而四足机器人在足式机器人中占有很大的比例，四足机器人的研究深具社会意义和实用价值。

2.2 研究对象数学模型分析

四足机器人整体结构由躯体、左前腿、右前腿、左后腿、右后腿五部分组成。

四足机器人的设计为两腿包含两个关节，分别为髋关节和膝关节，在关节位置添加驱动，这两个驱动为主动自由度，小腿为被动自由度。因此四足机器人整体包含4个髋关节自由度、4个膝关节自由度、以及4个小腿位置的被动自由度。选其中一条腿进行动力学分析。

机器人动力学分析常用的方法有牛顿－欧拉方程和拉格朗日法。拉格朗日法是一种功能平衡法，它只需要速度而不必求内作用力，是一种直截了当和简便的方法。利用拉格朗日法来分析和求解了三自由度步行足的动力学方程。

四足机器人的肢体结构如图2.1所示，侧摆关节在YOZ 平面转动， 1m 、2m 和3m 分别为侧摆、大腿和小腿的质量，且以腿末端的点质量表示， 1θ、2θ和3θ是关节转角，g 为重力加速度。

图2.1 四足机器人的肢体结构

机械系统的拉格朗日动力学方程为

i P i K i K q E q E q E dt d ∂∂+∂∂-∂∂= i T （1） 式（1）中，K E 为系统的总动能，P E 为系统的总势能，i q 是为关节的角度坐标，i q

为关节的角速度，i T 称为关节力矩。杆件i 质心的线速度和角速度可表示成：

q J q J q J i L i i Li i L =++=11i v （2）

q J q J q J i A i i Ai i A =++=11i ω （3）

式（2）、式（3）中Li J 和Ai J 分别是与第i 个连杆重心位置的平移速度和转动速度相关的雅可比矩阵，则：

系统的平动动能 ∑==n i i L T i L T i K q J J q m E 1

)()(121 （4） 系统的转动动能 ∑==n i i A i T i A T K q J I J q E 1)()(2

21 （5） 系统的总动能为平动动能和转动动能之和，为

∑=+=+=n i i A i T i A T i L T i L T i K K K q J I J q q J J q m E E E 1

)()()()(21)(21 q H q T 2

1= （6） 式（6）中H 由公式（7）获得

∑=+=n i i A i T i A i L T i L i

J I J J J m H 1)()()()()( （7）

系统的总势能为： i n

i T i p r g m E ,01∑== （8）

式（8）式中的i r ,0是第i 根杆件的质心在参考坐标系中的位置

由（1）、（6）、（8）式，得各关节力矩

j Li n j n

j T j n k k j ijk n j j ij J g m q q h q H

∑∑∑∑====++=1111i T （9） 式（9）中，i jk k ij

ijk q H q H h ∂∂-∂∂=5.0 （10）

2.3 ADAMS 专项技术原理分析

在 ADAMS 中建立模型的方法有2种：一种是利用ADAMS 自己的零件库建立

虚拟样机模型；一种是在其他三维建模软件建立模型，导入到ADAMS中，通过添加约束、运动函数和力等建立虚拟样机模型。虽然ADAMS有强大的仿真分析功能,但在实体建模功能比较薄弱,因此采用第2种方法，即在SolidWorks中建立三维模型，保存为*.x_t格式再导入(import)到ADAMS中。再加上相应的驱动和约束，就能实现模型在ADAMS中的仿真。

研究的四足机器人的足部结构为面接触式，同时抬起2条腿足以保证其稳定性，因此，在提高机器人爬行速度的考虑下，规划了机器人的爬行步态为以对角线的2条腿同时抬起行走；机器人重心在地面投影为直线；抬腿过程中，脚底板始终与地面平行；运动过程中四足爬行机器人机体始终保持与地面平行。这种步态可以在保证机器人平稳行走的同时，提高机器人的行走速度及效率。在1个周期内，机器人相当于迈步2次。机器人腿部抬起向前摆动，落地时通过脚面摩擦力使2条腿恢复原状同时带动机器人向前位移，2条腿同时抬起、同时恢复原位的方案也可以大大提高向前的动力。

根据四足机器人的独立驱动参数能够计算机体的运动位置和速度。机器人四条腿依次“抬起一摆动一放下”构成一个步态周期，一个步态周期需要分成若干个阶段以对应于每条腿“抬起一摆动一放下”。需要合理控制每条腿来保证行走的稳定性。

基于MATLAB建立其逆运动学分析运动曲线，将MATLAB生成的各个关节的变化曲线作为四足爬行机器人虚拟样机上各个相应舵机的输入量来控制舵机的变化，所以将MATLAB中得到的关节运动轨迹进行离散化，离散后的数据保存为文本文件。将离散后的数据（选择输入的.txt文件格式为TextData格式）导入到ADAMS中生成样条曲线（Spline）指定到相应的关节驱动中,这样，机器人各个关节就能够按照规划的轨迹运动。

2.4 ADAMS建模过程

1．三维建模

首先根据模型的相关尺寸在SolidWorks中建立四足机器人的零件进行三维模型，并最后装配成一个装配体。如图2.2所示。