机器人技术第5讲

一般机器人的动态方程由6个非线性微分方程联立表示，实际上除了一些简单的情况外，不可能 求得方程的一般解。在实际控制时往往对动态方程作出某些假设，进行简化处理。
2020/11/18
机器人技术第5讲
4.1 惯性矩
首先，在图4－1里通过把质点的平移运动改作回转运动的分析，来了解惯性矩的物理意义。
若将力F作用到质量为m的质点时的平 移运动，看作是运动方向的标量，则 可以表示为：
应该注意到各连杆的动能可用质量中心平移运动的动能和绕质量中心回转运动的动能之和 来表示。
由式（4－11），得到式（4－10）中的质量中心速度平方和为：
（4－12）
利用式（4－10）和式（4－12），（4－13），通过下式
2020/11/18
（4－13）
机器人技术第5讲
4.3 拉格朗日运动方程式
可求出拉格朗日算子L，把它代入式（4－6）的拉格朗日运动方程式，整理后可得： 式中：
2020/11/18
机器人技术第5讲
4.4.1 速度的计算
点P的速度为
（4.14）
2020/11/18
机器人技术第5讲
4.4.1 速度的计算 对于连杆i上任一点的速度为：
（4.15） P点的加速度
2020/11/18
机器人技术第5讲
4.4.1 速度的平方： 速度的计算
对于任一机械手上一点的速度平方为
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
（4－37）
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
是惯性力；
是离心力； 表示加在机械手上的重力项，g是重力加速度常数。
对于多于3个自由度的机械手，也可用同样的方法推导出运动方程式，但随自由度的增多演算量
将急剧增加。
式中，m（标量）是刚体的质量； 是绕重心C的惯性矩阵；F 是作用于重心的
平动力；N是惯性力矩；Vc是重心的平C移速度；为角 速
度。式（4－3）及式（4－4）分别被称为牛顿运动方程式及欧拉运动方程式。Ic的各元素表示对 应的力矩元素和角加速度元素间的惯性矩。
2020/11/18
机器人技术第5讲
4.2 牛顿、欧拉运动方程式
2020/11/18
机器人技术第5讲
4.4.3 动力学方程的推导
2020/11/18
机器人技术第5讲
3rew
演讲完毕，谢谢听讲!
再见，see you again
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
例：用拉格朗日运动方程式推导下图所示的单自由度系统力和加速度的关系， 车轮的质量忽略不计： 小车的动能为：
小车系统的势能为：
拉格朗日算子为：
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
拉格朗日函数的导数为：
因此小车系统的运动方程为：
2020/11/18
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
第1个连杆的动能K 、势能P 可分别表示为：
1
1
2020/11/18
（4－10）
机器人技术第5讲
4.3
式中，
拉格朗日运动方程式
是第i个连杆质量中心的位置向量。
2020/11/18
（4－11）
机器人技术第5讲
4.3 拉格朗日运动方程式
2020/11/18
机器人技术第5讲
4.4 机械手动力学方程
n 在分析了二连杆机械手的基础上，我们分析由一组 A变换描述的任何机械手，求其动力学方程。分以 下5步进行推导：
n （1） 计算任一连杆上任一点的速度； n （2） 计算各连杆的动能和机械手的总动能； n （3） 计算各连杆的位能和机械手的总位能； n （4） 建立机械手系统的拉格朗日函数； n （5） 对拉格朗日函数求导，以得到动力学方程。
机器人技术第5讲
4.3 拉格朗日运动方程式
现就前面讲的1自由度机械手来具体求解。假定为广义坐标，则有：
由于
2020/11/18
（4－8）
机器人技术第5讲
4.3 拉格朗日运动方程式
所以用置换式（4－6）的广义坐标后得到下式：
（4－9）
它与前面的结果完全一致。 下面推导图4－5所示的2自由度机械手的运动方 程式。 在推导时，把1，2当作广义坐标，1，2当 作广义力求拉格朗日算子，代入式（4－6）即可得 到。
2020/11/18
机器人技术第5讲
4.4 机械手动力学方程
2020/11/18
机器人技术第5讲
4.4.1 速度的计算
n 图中连杆3上点P的位置为：
式中， 为基坐标系中的位置矢量； 为局部（相对关节O ）坐标系中的位置矢量；
T 为变换矩阵，包括旋转和3 平移变换。 对3于任一连杆i上的一点，其位置为：
由于机器人是具有分布质量的三维、多自由度机构，利用牛顿力学建模非常困难，拉格朗日 力学成为主要的动力学分析方法。
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
拉格朗日运动方程式仅仅包涵能量项对系统变量和时间 的微分，结构简单，因此多数教科书利用该方程进行动力学 推导。
拉格朗日力学以两个方程为基础：一个是直线运动，另 一个针对旋转运动。
把这些公式代入（4－4），提取只有z分量的回转则得到：
2020/11/18
机器人技术第5讲
4.2 牛顿、欧拉运动方程式
式中：
（4－5）
对于一般形式的连杆，由于I除第三分量以外，其它分量皆不为零，所以×I不是零向量。 ×I的第1，2分量成了改变轴方向的力矩，但在固定轴的场合，与这个力矩平衡的约束力生成 式N的第1，2分量，不产生运动。
2020/11/18
(4.16)
机器人技术第5讲
4.4.2 动能和位能的计算 令连杆3上任一质点P的质量为dm，则其动能为：
任一机械手连杆i上位置矢量 的质点，其动能为
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 对连杆3积分dK 得连杆3的动能为： 3，
式中，
积分称为连杆的伪惯量矩阵，并记为：
式中： 表示加速度。若把这一运动看作是质量可以忽略的棒长为r的回转运动，则得到加速度和力 的关系式为：
2020/11/18
机器人技术第5讲
4.1 惯性矩
式中， 和N是绕轴回转的角加速度和惯性力矩，将 和F代入上式得：
令
，上式可以变为：
（4－1）
式（4－1）是质点绕固定轴进行回转运动时的运动方程式，I相当于平动时的质量，称为惯性矩。 求质量连续分布物体的惯性矩时，可以将其分割成假想的微小物体，然后将微小物体的惯性矩加 在一起，这时，微小物体的质量dm及其微小物体体积dV的关系可用密度表示为：
Pai一般是很小的，一般忽略不计，这时，机械手的总位能为
4.4.3 动力学方程的推导
拉格朗日算子：
2020/11/18
机器人技术第5讲
对上式求导 4.4.3 动力学方程的推导
拉格朗日算子：
2020/11/18
机器人技术第5讲
4.4.3 动力学方程的推导
2020/11/18
机器人技术第5讲
4.4.3 动力学方程的推导
方法： 1 牛顿—欧拉法； 2 拉格朗日方法。
2020/11/18
机器人技术第5讲
第四章 机器人动力学
牛顿欧拉法从运动学出发求得加速度，并消去各内作用力。拉格朗日方法，它只需要速度而不必 求内作用力，是比较直接的方法。
对于动力学，有两个相反的问题：一是动力学的正问题：已知机械手各关节的作用力或力矩，求 各关节的位移、速度和加速度。主要应用于仿真研究；二是动力学的逆问题：已知机械手的运动轨 迹，即各关节的位移、速度、加速度求各关节所需要的驱动力或力矩。主要是实时控制的需要
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 任何机械手上任一连杆i的动能为：
（4.17) 式中，Ii为伪惯量矩阵，其表达式为：
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 式中，Ii为伪惯量矩阵，其表达式为：
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 物体的转动惯量、矢量积以及一阶矩量为：
下面我们来求图4－4所示1自由度机械手的运动方程式。这 种场合，由于关节轴制约连杆的运动，所以可以把式（4－4） 的运动方程式看作是绕固定轴的运动。假定绕关节轴的惯性矩 为I，取垂直纸面的方向为Z轴，则得到：
2020/11/18
机器人技术第5讲
4.2 牛顿、欧拉运动方程式
式中：g为重力常数；
是在第三行第三列上具有绕关节轴的惯性矩阵，
机器人技术第5讲
2020/11/18
机器人技术第5讲
第四章 机器人动力学
机器人动力学方程可以确定机器人的运动，但实际上除最简单的情况外，求解机器人的全部动力 学方程几乎是不可能的。
作用： 1 确定力和力矩，以便在机器人连杆和关节上产生期望的加速度； 2 考察不同负载对机器人的影响及根据期望的加速度来考察某些负载的重要性；
2020/11/18
机器人技术第5讲
4.3 拉格朗日运动方程式
拉格朗日运动方程式可表示为：
（4－6）
式中，q是广义坐标，是广义力，当为直线运动时，为力的单位，当为转动时，它为力矩的 单位。拉格朗日运动方程式也可表示为：
（4－7）
这里，L是拉格朗日算子；K是动能；P是势能。
2020/11/18
机器人技术第5讲
2020/11/18
机器人技术第5讲
4.1 惯性矩
那么，它的惯性矩为：
整个物体的惯性矩可用下式表示： （4－2）
例4.1 求图4－2所示质量为M，长度为L的匀质杆（粗细忽略），绕其一端回转时的惯性矩I。
2020/11/18
机器人技术第5讲
4.1 惯性矩
解：微小物体的质量用线密度（＝M/L）表示， 所以其惯性矩为 。因此将dI在长度方向积分， 即可得到：
2020/11/18
机器人技术第5讲
4.4 机械手动力学方程
n 下图表示一个四连杆机械手的结构。我们先从 这个例子出发，求得此机械手某个连杆（例如 连杆3）上某一点（P）的速度、质点和机械手 的动能与位能、拉格朗日算子，求系统的动力 学方程。然后，由特殊到一般，导出任何机械 手的速度、动能、位能和动力学方程的一般表 达式。
（4.19)
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 下面计算机械手的位能，一个高度为h，质量为m的物体其位能为：
P＝mgh
连杆i上位置 处的质点dm，其位能百度文库：
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 其中，mi为连杆I的质量， 为连杆I相对于其前端关节坐标系的重心位置，由于传动装置的重力作用
例4－2 试求上例的杆绕重心回转时的惯性矩I 。 解：由于该杆是重心位于中心的匀质杆，因此，C 可先就杆的一半来求解，然后再加倍即可。假定 x为离杆中心的距离，则得到：
2020/11/18
机器人技术第5讲
4.2 牛顿、欧拉运动方程式
图4－3所示的单一刚体的运动方程式可用下式来表示：
（4－3）
（4－4）
如果令
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算
于是可把Ii表示为（4.18)：
2020/11/18
机器人技术第5讲
4.4.2 动能和位能的计算 具有n个连杆的机械手总的动能为：
连杆i的传动装置动能为 式中，Iai为传动装置的等效转动惯量，对于平动关节，Iai为等效质量； 传动关节的传动装置总动能为