第4章-机器人动力学.ppt

《第4章-机器人动力学.ppt》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、机器人学基础国家级《智能科学基础系列课程教学团队》“机器人学”课程配套教材蔡自兴主编中南大学20092第四章机器人动力学分析机器人操作的动态数学模型，主要采用下列两种理论：动力学基本理论，包括牛顿—欧拉方程。拉格朗日力学，特别是二阶拉格朗日方程。对于动力学，有两个相反的问题：其一是已知机械手各关节的作用力或力矩，求各关节的位移、速度和加速度，求得运动轨迹。其二是已知机械手的运动轨迹，即各关节的位移、速度和加速度，求各关节所需要的驱动力或力矩。机器人学基础34.1刚体动力学拉格朗日函数L被定义为系统的动能K和位能P之差，即:系统

2、动力学方程式，即拉格朗日方程如下：式中，为表示动能和位能的坐标，为相应的速度，而为作用在第i个坐标上的力或是力矩。第四章机器人动力学4.1.1刚体的动能与位能44.1刚体动力学图4.1一般物体的动能与位能54.1.1刚体的动能与位能为广义坐标其中，左式第一项为动能随速度（或角速度）和时间的变化；第二项为动能随位置（或角度）的变化；第三项为能耗随速度变化；第四项为位能随位置的变化。右式为实际外加力或力矩。表示为一般形式：4.1刚体动力学64.1.1刚体的动能与位能均为广义坐标，有下式：或用矩阵形式表示为：4.1刚体动力学74.1

3、.1刚体的动能与位能二连杆机械手的动能和位能4.1刚体动力学图4.2二连杆机器手（1）4.1.1刚体的动能与位能二连杆机械手系统的总动能和总位能分别为：84.1刚体动力学94.1.2动力学方程的两种求法拉格朗日功能平衡法二连杆机械手系统的拉格朗日函数L为：求得力矩的动力学方程式：4.1刚体动力学10拉格朗日功能平衡法比较可得本系统各系数如下：有效惯量耦合惯量向心加速度系数4.1.2动力学方程的两种求法11拉格朗日功能平衡法哥氏加速度系数重力项4.1.2动力学方程的两种求法12拉格朗日功能平衡法表4.1给出这些系数值及其与位置的

4、关系。表4.1负载地面空载09018027010-1064242101111164242323地面满载09018027010-1018102108404444418102102626外空间负载09018027010-10402202220220010001001001001001004022022202210221024.1.2动力学方程的两种求法134.1.2动力学方程的两种求法牛顿-欧拉动态平衡法二连杆系统的动力学方程的一般形式为：式中的W、K、D、P和qi等的含义与拉格朗日法一样；i为连杆代号，n

5、为连杆数目。4.1刚体动力学14牛顿-欧拉动态平衡法质量的位置矢量（见图4.3）为：4.1.2动力学方程的两种求法图4.3二连杆机械152．牛顿-欧拉动态平衡法可得:4.1.2动力学方程的两种求法4.2机械手动力学方程分析由一组A变换描述的任何机械手，求出其动力学方程。推导过程分五步进行：计算任一连杆上任一点的速度；计算各连杆的动能和机械手的总动能；计算各连杆的位能和机械手的总位能；建立机械手系统的拉格朗日函数；对拉格朗日函数求导，以得到动力学方程式。16第四章机器人动力学图4.4四连杆机械手174.2.1速度的计算连杆3上点

6、P的速度为：对于连杆i上任一点的速度为：4.2机械手动力学方程184.2.1速度的计算P点的加速度为：4.2机械手动力学方程194.2.1速度的计算速度的平方式中，Trace表示矩阵的迹。对于n阶方程来说，其迹即为它的主对角线上各元素之和。4.2机械手动力学方程204.2.1速度的计算任一机械手上一点的速度平方为：4.2机械手动力学方程214.2.2动能和位能的计算动能的计算令连杆3上任一质点P的质量为dm，则其动能为：4.2机械手动力学方程22动能的计算任一机械手连杆i上位置矢量的质点，其动能为：连杆3的动能为：4.2.2动

7、能和位能的计算23动能的计算任何机械手上任一连杆i动能为：式中，为伪惯量矩阵。具有n个连杆的机械手总的功能为：4.2.2动能和位能的计算24动能的计算连杆的传动装置动能为：所有关节的传动装置总动能为：机械手系统（包括传动装置）的总动能为：4.2.2动能和位能的计算254.2.2动能和位能的计算位能的计算一个在高度h处质量m为的物体，其位能为：连杆i上位置处的质点dm，其位能为：式中，。4.2机械手动力学方程26位能的计算连杆上位置处的质点dm，其位能为：机械手系统的总位能为：4.2.2动能和位能的计算274.2.3动力学方程的

8、推导据式(4.1)求拉格朗日函数4.2机械手动力学方程284.2.3动力学方程的推导再据式(4.2)求动力学方程，先求导数4.2机械手动力学方程294.2.3动力学方程的推导据式(4.18)知，为对称矩阵，即，所以下式成立：4.2机械手动力学方程304.2.3动力学方程的推导