机器人机械臂运动学分析(仅供借鉴)

1、平面二自由度机械臂动力学分析摘要机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。本文采用拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过研究得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。关键字平面二自由度一、介绍机器人是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是一个 受到关注的研究课题。机器人动力学问题有两类： (1) 给出已知的轨迹点上的 丄；，即机器人关节位

2、置、速度和加速度，求相应的关 节力矩向量Q。这对实现机器人动态控制是相当有用的。(2) 已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩 向量T求机器人所产生的运动 民&及日。这对模拟机器人的运动是非常有用的。二、二自由度机器臂动力学方程的推导过程机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统 动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下：(1) 选取坐标系，选定完全而且独立的广义关节变量Or , r=1,2,n。(2) 选定相应关节上的广义力Fr :当O r是位移变量时，Fr为力；当O r是角度变量时，Fr为

3、力矩。(3) 求出机器人各构件的动能和势能，构造拉格朗日函数。(4) 代入拉格朗日方程求得机器人系统的动力学方程。下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。1、分别求出两杆的动能和势能设齐、B 2是广义坐标，Qi、Q2是广义力。两个杆的动能和势能分别为:(1 一 1)杆2；di%dt妬+ /価（耳+幺）1一41r1 殳场二睥ZZ別斗日2） . 6 =气目冃竝耳+% in（坷+鬼）12式中，=是杆i质心Ci r- /）的速度向量，.是杆2质心CiJ）的速度向量。它们可以根据质心 Ci、C2的位置方程导出V V2、分别求出两杆的速度*(1-3)3、代入拉格朗日方程求得机械臂动力学

4、方程根据具有完整理想约束的有N个广义坐标系统的拉格朗日方程(1-5)式中qr第r个广义坐标；E系统动能；U系统势能；Qr 对第r个广义坐 标的广义力。该问题的为二自由度的动力学研究，贝Un=2，且由于势能函数 U与广义速度无关，即=0由（1-5）式可写成:C1-6J其中：Z = -M E称対杭格朗日軍于在这个研究中拉格朗日算子为:代入式（1-6 ）导出相应的式子，最后整理成(1-7)M（甸屛 C（&/）+迪=0式中口恥）二能）二11 =沟：+ 4l +叩;+（ +细仿阿卽+&叽二叫匚。&為）+4,-陆=陌空,胚芯二舛：*/J J6 =-叫希血4 （&卄2日1 &） . G =叫血色&】gj =

5、叫 e久十阻凶片&i+f旳皿風十即务二他倉；c“（q十站）式（1-7）就是操作臂在关节空间的动力学方程的一般结构形式，它反映了关节力矩与关 节变量、速度、加速度之间的函数关系。对于n个关节的操作臂， M e ）是nxn的正定对称矩阵，是e的函数，称为操作臂的惯性矩阵；L庁 是nxi的离心力和科氏力矢量；g（e）是nxi的重力矢量，与操作臂的形位e有关。4、操作空间动力学方程与关节空间动力学方程相对应，在笛卡儿操作空间中可以用直角坐标变量即末端操作器*位姿的矢量X表示机器人动力学方程。因此，操作力F与末端加速度-1之间的关系可表示为0-3)式中分别为操作空间惯性矩阵、离心力和科氏力矢量、重 力矢量，它们都是在操作空间中表示的；F是广义操作力矢量。关节空间动力学方程和操作空间动力学方程之间的对应关系可以