平面二自由度机械臂动力学分析
摘要机器臂是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，这里主要对平面二自由度机械臂进行动力学研究。本文采用拉格朗日方程在多刚体系统动力学的应用方法分析平面二自由度机械臂的正向动力学。经过研究得出平面二自由度机械臂的动力学方程，为后续更深入研究做铺垫。
关键字平面二自由度
一、介绍
机器人是一个非线性的复杂动力学系统。动力学问题的求解比较困难，而且需要较长的运算时间，因此，简化解的过程，最大限度地减少工业机器人动力学在线计算的时间是一个受到关注的研究课题。
机器人动力学问题有两类：
1给出已知的轨迹点上的
，即机器人关节位置、速度和加速度，求相应的关
节力矩向量Qr。这对实现机器人动态控制是相当有用的。
2已知关节驱动力矩，求机器人系统相应的各瞬时的运动。也就是说，给出关节力矩
向量τ，求机器人所产生的运动
。这对模拟机器人的运动是非常有用的。
二、二自由度机器臂动力学方程的推导过程
机器人是结构复杂的连杆系统，一般采用齐次变换的方法，用拉格朗日方程建立其系统动力学方程，对其位姿和运动状态进行描述。机器人动力学方程的具体推导过程如下：
1选取坐标系，选定完全而且独立的广义关节变量θr，r12…
。2选定相应关节上的广义力Fr：当θr是位移变量时，Fr为力；当θr是角度变量时，Fr为力矩。3求出机器人各构件的动能和势能，构造拉格朗日函数。4代入拉格朗日方程求得机器人系统的动力学方程。下面以图1所示说明机器人二自由度机械臂动力学方程的推导过程。
1、分别求出两杆的动能和势能
f设θ1、θ2是广义坐标，Q1、Q2是广义力。两个杆的动能和势能分别为：
式中，是杆1质心C1（）的速度向量，是杆2质心C1（）的速度向量。它们可以根据质心C1、C2的位置方程导出
2、分别求出两杆的速度、
3、代入拉格朗日方程求得机械臂动力学方程根据具有完整理想约束的有N个广义坐标系统的拉格朗日方程式中qr第r个广义坐标；E系统动能；U系统势能；Qr对第r个广义坐标的广义力。该问题的为二自由度的动力学研究，则
2，且由于势能函数U与广义速度无关，即由（15）式可写成：
在这个研究中拉格朗日算子为：代入式（16）导出相应的式子，最后整理成式中
f式17就是操作臂在关节空间的动力学方程的一般结构形式，它反映了关节力矩与关节变量、速度、加速度之间的函数关系。对于
个r