5、机器人动力学.pptxVIP

《机器人学》 第五章、机器人动力学战 强北京航空航天大学机器人研究所第五章、机器人动力学机器人动力学是研究机器人的运动和作用力之间的关系。机器人动力学的用途：机器人的最优控制；优化性能指标和动态性能、调整伺服增益；设计机器人：算出实现预定运动所需的力/力矩；机器人的仿真：根据连杆质量、负载、传动特征的动态性能仿真。机器人是一个具有多输入和多输出的复杂的动力学系统，存在严重的非线性，需要非常系统的方法来处理。动力学的原问题：给定力/力矩，求解机器人的运动； 是非线性的微分方程组，求解困难。动力学的逆问题：已知机器人的运动，计算相应的力/力矩， 即实现预定运动所需施加的力矩；不求解 非线性方程组，求解简单。动力学方法很多，如Lagrange、Newton-Euler、Gauss、Kane、Screw、Roberson-Wittenburg。5.1 Lagrange动力学方法Lagrange法：能以最简单的形式求得非常复杂的系统动力学方程，而且具有显式结构。Lagrange函数L定义：任何机械系统的动能 和势能 之差动能和势能可以用任意选取的坐标系来表示，不局限于笛卡儿坐标假设机器人的广义坐标为则该机械系统的动力学方程为：（5-1）广义速度将代入到（5-1）式中：（5-2）rr1Y?X例：图示R-P机器人，求其动力学方程。1、质心的位置和速度为了写出连杆1和连杆2（质量 和 ）的动能和势能，需要知道它们的质心在共同的笛卡儿坐标系中的位置和速度。 笛卡儿Cartesian(Latin)[ka:’ti:zj?n] Descartes[dei’ka:t]:法国哲学家、 数学家、物理学家，1596-1650，将笛卡尔坐标体系公式化而被认为是解析几何之父。质心 的位置是速度是速度的模方是质心 的位置是速度是速度的模方是2、机器人的动能3、机器人的势能4、机器人的动力学方程根据式5-2，分别计算关节1和关节2上的力/力矩关节1上的作用力加速度部分 速度部分 位置部分关节2上的作用力该方程表示关节上的作用力与各连杆运动之间的关系该R-P机器人的动力学方程为：4、Lagrange动力学方程的一般形式惯性力项哥式力项向心力项重力项对照可得：有效惯量对于移动关节是质量，对于转动关节是惯性矩机器人的有效惯性量和耦合惯性量，随机器人的形态变化而变化，跟负载、机器人是自由状态/锁死状态有关，变换范围大，对机器人的控制影响巨大。对于一个机器人的控制而言，需要计算出各个有效惯量、耦合惯量与机器人位置形态之间的关系。rr1Y?X假设R-P机器人的实际参数为：例:YX重力负载变化极大，在垂直状态是零，在水平时是最大（196）对机器人控制影响很大，在实际中采用平衡的方法或前馈补偿的方法。Lagrange动力学方法的基本步骤：1、计算各连杆的质心的位置和速度；2、计算机器人的总动能；3、计算机器人的总势能；4、构造Lagrange函数L；5、推导动力学方程。ZhYwlX5.2 惯性矩阵、惯性积和惯性张量在R-P机器人的例子中假设各连杆的质量集中在一点，实际上各连杆的质量是均匀分布的，对于这种情况存在几个特殊的公式。1、图示均质刚体，绕X、Y、Z轴的惯性矩阵定义为：{A}2、惯性积（混合矩）定义为：3、对于给定的坐标系{A}，惯性张量定义为相对于某一坐标系的质量分布的二阶矩阵，表示物体的质量分布惯性张量跟坐标系的选取有关，如果选取的坐标系使各惯性积为零，则此坐标系下的惯性张量是对角型的，此坐标系的各轴叫惯性主轴，质量矩叫主惯性矩。刚体质量和分布的一阶矩阵定义为：4、伪惯性矩阵定义为质量分布的一阶矩和二阶矩的向量组成伪惯性矩阵与惯性张量之间的关系为：伪惯性矩阵与选取的坐标系有关，如果选取的坐标系的原点在刚体的质心，且选取坐标轴的方向使,则此坐标系称为刚体的主坐标系,伪惯性矩阵为对角型的.相对于原点的惯性矩ZhYwlX例：如图示坐标系，求密度为 的均匀长方体的惯性张量和伪惯性矩阵。{A}解： 长方体的质量为 质心坐标为 惯性矩为 惯性积为惯性张量为伪惯性矩阵为惯性张量和伪惯性矩阵代表刚体质量分布相对于某一坐标系的二阶矩和一阶矩，具有下列特点：1）所有惯性矩恒为正，惯性积可正可负；2）当坐标系方位改变时， 不变；3）惯性张量的特征值和特征矢量分别为刚体相应的主惯性矩 和惯性主轴。5.3 Newton-Euler动力学方法1、达朗贝尔原理达朗贝尔原理：对于任何物体，外加力和运动阻力（惯性力）在任何方向上的代数和为零。将静力平衡条件用于动力学问题。一个刚体的运动可分解为固定在刚体上的任意一点的移动以及该刚体绕这一点的转动两部分,因此达朗贝尔原理可表示成两部分:1）、牛顿第二定律（力平衡方程）：作用在连