机械系统动力学作业---平面二自由度机械臂运动学分析.pdfVIP

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