第4章机器人动力学.ppt

第4章机器人动力学.ppt

《第4章机器人动力学.ppt》由会员分享，可在线阅读，更多相关《第4章机器人动力学.ppt（32页珍藏版）》请在冰豆网上搜索。

1第四章机器人动力学分析机器人操作的动态数学模型，主要采用下列两种理论：

动力学基本理论，包括牛顿欧拉方程。

拉格朗日力学，特别是二阶拉格朗日方程。

对于动力学，有两个相反的问题：

其一是已知机械手各关节的作用力或力矩，求各关节的位移、速度和加速度，求得运动轨迹。

其二是已知机械手的运动轨迹，即各关节的位移、速度和加速度，求各关节所需要的驱动力或力矩。

机器人学基础24.1刚体动力学拉格朗日函数L被定义为系统的动能K和位能P之差，即:

系统动力学方程式，即拉格朗日方程如下：

式中，为表示动能和位能的坐标，为相应的速度，而为作用在第i个坐标上的力或是力矩。

第四章机器人动力学4.1.1刚体的动能与位能34.1刚体动力学图4.1一般物体的动能与位能错误！

44.1.1刚体的动能与位能为广义坐标其中，左式第一项为动能随速度（或角速度）和时间的变化；第二项为动能随位置（或角度）的变化；第三项为能耗随速度变化；第四项为位能随位置的变化。

右式为实际外加力或力矩。

表示为一般形式：

4.1刚体动力学54.1.1刚体的动能与位能均为广义坐标，有下式：

或用矩阵形式表示为：

4.1刚体动力学64.1.1刚体的动能与位能二连杆机械手的动能和位能4.1刚体动力学图4.2二连杆机器手

（1）4.1.1刚体的动能与位能二连杆机械手系统的总动能和总位能分别为：

74.1刚体动力学84.1.2动力学方程的两种求法拉格朗日功能平衡法二连杆机械手系统的拉格朗日函数L为：

求得力矩的动力学方程式：

4.1刚体动力学9拉格朗日功能平衡法比较可得本系统各系数如下：

有效惯量耦合惯量向心加速度系数4.1.2动力学方程的两种求法10拉格朗日功能平衡法哥氏加速度系数重力项4.1.2动力学方程的两种求法11拉格朗日功能平衡法表4.1给出这些系数值及其与位置的关系。

表4.1负载地面空载09018027010-1064242101111164242323地面满载09018027010-1018102108404444418102102626外空间负载09018027010-10402202220220010001001001001001004022022202210221024.1.2动力学方程的两种求法124.1.2动力学方程的两种求法牛顿-欧拉动态平衡法错误！

二连杆系统的动力学方程的一般形式为：

式中的W、K、D、P和qi等的含义与拉格朗日法一样；i为连杆代号，n为连杆数目。

4.1刚体动力学13牛顿-欧拉动态平衡法质量的位置矢量（见图4.3）为：

4.1.2动力学方程的两种求法图4.3二连杆机械142牛顿-欧拉动态平衡法可得:

4.1.2动力学方程的两种求法4.2机械手动力学方程分析由一组A变换描述的任何机械手，求出其动力学方程。

推导过程分五步进行：

计算任一连杆上任一点的速度；计算各连杆的动能和机械手的总动能；计算各连杆的位能和机械手的总位能；建立机械手系统的拉格朗日函数；对拉格朗日函数求导，以得到动力学方程式。

15第四章机器人动力学图4.4四连杆机械手164.2.1速度的计算连杆3上点P的速度为：

对于连杆i上任一点的速度为：

4.2机械手动力学方程174.2.1速度的计算P点的加速度为：

4.2机械手动力学方程184.2.1速度的计算速度的平方式中，Trace表示矩阵的迹。

对于n阶方程来说，其迹即为它的主对角线上各元素之和。

4.2机械手动力学方程194.2.1速度的计算任一机械手上一点的速度平方为：

4.2机械手动力学方程204.2.2动能和位能的计算动能的计算令连杆3上任一质点P的质量为dm，则其动能为：

4.2机械手动力学方程21动能的计算任一机械手连杆i上位置矢量的质点，其动能为：

连杆3的动能为：

4.2.2动能和位能的计算22动能的计算任何机械手上任一连杆i动能为：

式中，为伪惯量矩阵。

具有n个连杆的机械手总的功能为：

4.2.2动能和位能的计算23动能的计算连杆的传动装置动能为：

所有关节的传动装置总动能为：

机械手系统（包括传动装置）的总动能为：

4.2.2动能和位能的计算244.2.2动能和位能的计算位能的计算一个在高度h处质量m为的物体，其位能为：

连杆i上位置处的质点dm，其位能为：

式中，。

4.2机械手动力学方程25位能的计算连杆上位置处的质点dm，其位能为：

机械手系统的总位能为：

4.2.2动能和位能的计算264.2.3动力学方程的推导据式（4.1）求拉格朗日函数4.2机械手动力学方程274.2.3动力学方程的推导再据式（4.2）求动力学方程，先求导数4.2机械手动力学方程284.2.3动力学方程的推导据式（4.18）知，为对称矩阵，即，所以下式成立：

4.2机械手动力学方程294.2.3动力学方程的推导4.2机械手动力学方程304.2.3动力学方程的推导4.2机械手动力学方程314.2.3动力学方程的推导具有n个连杆的机械手系统动力学方程如下：

4.2机械手动力学方程324.3小结研究刚体动力学问题，着重分析了机器人机械手动力学方程的两种求法：

拉格朗日功能平衡法牛顿欧拉动态平衡法在分析二连杆机械手的基础上，总结出建立拉格朗日方程的步骤，并据之计算出机械手连杆上一点的速度、动能和位能，进而推导出四连杆机械手的动力学方程及其简化计算公式。

第四章机器人动力学