资源描述
与动力学有关的两个问题:已知一个轨迹点,希望 求出期望的关节力矩矢量 .计算在施加一组关节力矩的情况下机构如何运动.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.1 6.1 概述概述概述概述第 6 章:操作臂动力学 6.1 概述 在任一瞬时，对刚体的线速度和角速度进行求导，可分别得到线加速度和角加速度:同速度一样，当微分的参考坐标系为世界坐标系U时，可用下列符号表示刚体的速度，即:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.2 6.2 刚体的加速度刚体的加速度刚体的加速度刚体的加速度 在任一瞬时，对刚体的线速度和角速度进行求 1.线加速度 描述了坐标系 A下的速度矢量，当坐标系A和坐标系B的原点重合时:因为两个坐标系的原点重合，因此可以将上式改写为:对 求微分,得到 相对于A的加速度：因为:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.2 6.2 刚体的加速度刚体的加速度刚体的加速度刚体的加速度 1.线加速度第 6 章:操作臂动力学 6.2 所以有 当两个坐标系原点不重合时:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.2 6.2 刚体的加速度刚体的加速度刚体的加速度刚体的加速度 所以有第 6 章:操作臂动力学 6.2 刚体的加 当 是常数，加速度的推导公式化简为:对于旋转关节的操作臂，上式为操作臂连杆的线加速度.对于移动关节，常用(*)式.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.2 6.2 刚体的加速度刚体的加速度刚体的加速度刚体的加速度 当 是常数，第 6 章:操作臂动力 2.角加速度 假设 B相对于A以 转动，同时 C 相对于 B 以 转动.求 在A中进行矢量叠加:求导，得到:因为有 于是得到操作臂连杆的角加速度.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.2 6.2 刚体的加速度刚体的加速度刚体的加速度刚体的加速度 2.角加速度第 6 章:操作臂动力学 6.惯性张量可以在任意坐标系中定义，但一般在固连在刚体上的坐标系中定义惯性张量.坐标系 A 中的惯性张量可用 33 矩阵表示:矩阵中的各元素如下:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 惯性张量可以在任意坐标系中定义，但一般在 式子中刚体由单元体 组成 单元体的密度为 .每个单元体的位置由矢量 确定.-The elements are called the mass moments of inertia.We are integrating the mass elements,times the squares of the perpendicular distances from the corresponding axis.-The elements with mixed indices are called the mass products of inertia.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 式子中刚体由单元体 组成第 6 章:例:求图中坐标系中长方体的惯量张量.已知长方体密度均匀，其大小 解：计算 :Permuting the terms:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 例:求图中坐标系中长方体的惯量张量.已知长方体 图示物体的惯性张量阵:惯性张量是坐标系位姿的函数.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布第 6 章:操作臂动力学 6.3 质量分布 平行移轴定理:矢量 表示刚体质心在坐标系A中的位置。矢量矩阵形式：第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 平行移轴定理:第 6 章:操作臂动力 例:当坐标系原点在刚体质心时，求图中刚体的惯性张量.运动平行移轴定理:Next,we find:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 例:当坐标系原点在刚体质心时，求图中刚体的惯性 其它参量由对称性得出：第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 其它参量由对称性得出：第 6 章:操作 惯性张量的其他性质:-如果由坐标系的两个坐标轴构成的平面为刚体质量分布的对称平面，则正交于这个对称平面的坐标轴与另一个坐标轴的惯量积为0.-惯量距永远是正值，而惯量积可能正，可能负.-三个惯量距的和保持不变.-惯性张量的特征值为刚体的主惯量距，相应的特征矢量为主轴。.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 惯性张量的其他性质:第 6 章:操作臂动力学 大多数操作臂连杆的几何形状及结构比较复杂，一般使用测量装置来测量。第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布 大多数操作臂连杆的几何形状及结构比较复 大多数操作臂连杆的几何形状及结构比较复杂，一般使用测量装置来测量。第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布承物台承物台遮光细棒遮光细棒塔轮塔轮光电门光电门滑滑轮轮砝砝码码 大多数操作臂连杆的几何形状及结构比较复第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布刚体的转动惯量的测量刚体的转动惯量的测量转动体系由承物台和塔轮组成，空承物台转动转动体系由承物台和塔轮组成，空承物台转动时，体系对转轴的转动惯量为时，体系对转轴的转动惯量为J0，另有待测物，另有待测物放在承物台上时，总转动惯量为：放在承物台上时，总转动惯量为：若分别测出若分别测出J和和J0，则待测物体的转动惯量，则待测物体的转动惯量Jx为：为：第 6 章:操作臂动力学 6.3 质量分布刚体的转动惯量第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.3 6.3 质量分布质量分布质量分布质量分布刚体系受刚体系受外力矩外力矩有：绳子的张力作用力矩有：绳子的张力作用力矩MT和和摩擦力矩摩擦力矩M。由转动定律知：由转动定律知：为角加速度。为角加速度。即：即：可见，测量转动惯量可见，测量转动惯量J的的关键是测量角加速度和关键是测量角加速度和摩擦力矩！摩擦力矩！J 是是转动体系的体系的转动惯量，量，是角加速度，是角加速度，m 是下落砝是下落砝码的的质量，量，r 是是绕线轮的半径，的半径，M 是摩擦力矩是摩擦力矩。第 6 章:操作臂动力学 6.3 质量分布刚体系受外力矩 1.牛顿欧拉方程 要使连杆运动，必须对连杆进行加速和减速运动，连杆运动所需的力是关于连杆期望加速度及其质量分布的函数。牛顿方程以及描述旋转运动的欧拉方程描述了力、惯量和加速度之间的关系。.牛顿方程:欧拉方程 第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 1.牛顿欧拉方程 第 6 章:操作臂动力学 2.向外迭代为了计算作用在连杆上的惯性力，需要计算操作臂每个连杆在某一时刻的角速度、线加速度和角加速度.可应用迭代方法完成这些计算。首先对连杆1进行计算，接着计算下一个连杆，这样一直向外迭代到连杆n计算出每个连杆质心的线加速度和角加速度之后，运动牛顿欧拉公式计算出作用在连杆质心上的惯性力和力矩.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 2.向外迭代第 6 章:操作臂动力学 6.4 角速度在连杆之间的“传递问题”:连杆之间的角加速度变换方程:当第 i+1个关节是移动关节,上式简化为:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 角速度在连杆之间的“传递问题”:第 6 章:操 每个连杆坐标系原点的线加速度:对于i+1是移动关节时:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 每个连杆坐标系原点的线加速度:第 6 章:操作臂 每个连杆质心的线加速度:假设坐标系 Ci固连于连杆i上,坐标系原点位于连杆质心，且各坐标轴方位与原连杆坐标系i方位相同。注意，第1个连杆的方程非常简单，因为 .第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 每个连杆质心的线加速度:第 6 章:计算出每个连杆质心的线加速度和角加速度之后，运动牛顿欧拉公式计算出作用在连杆质心上的惯性力和力矩:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 计算出每个连杆质心的线加速度和角加速 3.向内迭代法列出力平衡和力矩平衡方程.每个连杆都受到相邻连杆的作用力和力矩以及附加的惯性力和力矩.计算出每个连杆上的力和力矩之后，计算关节力矩.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 3.向内迭代法第 6 章:操作臂动力学 6.将所有作用在连杆i上的力相加，得到力平衡方程:将所有作用在质心上的力矩相加，并且令它们的和为零，得到力平衡方程:最后重新排列力和力矩方程，形成相邻连杆从高序号向低序号排列的迭代关系：第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 将所有作用在连杆i上的力相加，得到力平衡方程:第 在静力学中，可通过计算一个连杆施加于相邻连杆的力矩在 方向的分量求得关节力矩:注意对一个在自由空间中运动的机器人来说,和 等于零.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 在静力学中，可通过计算一个连杆施加于相 牛顿-欧拉迭代动力学算法 由关节运动计算关节力矩的完整算法由两部分组成:-对每个连杆应用牛顿-欧拉方程，从连杆1到连杆n向外迭代计算连杆的速度和加速度.-从连杆n到连杆1向内迭代计算连杆间的相互作用力和力矩以及关节驱动力矩.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 牛顿-欧拉迭代动力学算法第 6 章:操作臂动力学 对于转动关节，该算法归纳如下:-外推:i:0 5第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 对于转动关节，该算法归纳如下:第 6 章:操作臂动 -内推:i:6 1考虑重力：令 第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 -内推:i:6 1第 6 章:操 例:计算二连杆操作臂的动力学方程.假设质量分布非常简单：每个连杆的质量都集中在连杆的末端，设其质量分别为 和 .首先，确定牛顿欧拉迭代公式中各参量的值:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 例:计算二连杆操作臂的动力学方程.假设质量分布 旋转矩阵:对连杆 1 向外迭代:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 旋转矩阵:第 6 章:操作臂动力学 6.4 对连杆 2 向外迭代:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 对连杆 2 向外迭代:第 6 章:操作臂动力学 对连杆 2 向内迭代:对连杆 1 向内迭代:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 对连杆 2 向内迭代:第 6 章:操作臂动力学 取 中的 方向分量,得关节力矩:将驱动力矩表示为关于关节位置、速度和加速度的函数.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.4 6.4 牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程牛顿欧拉方程 取 中的 方向分量,得关节 1.迭代形式与封闭形式的动力学方程 迭代形式的动力学方程有两个作用:-进行数值计算.-作为一种分析方法用于符号方程的推导.我们经常需要对方称的结构进行研究。2.状态空间方程 当用牛顿-欧拉方程对操作臂进行分析时，动力学方程可以写成如下形式:这里 是 nn 操作臂的质量矩阵,是n1的离心力和哥氏力矢量，是n1重力矢量.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.5 6.5 操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构 1.迭代形式与封闭形式的动力学方程第 6 章:包含了所有与关节速度有关的项.例:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.5 6.5 操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构 包含了所 :n1 Coriolis 项.包含了所有与关节速度有关的项 是与离心力有关的项，因为它是速度的平方.是与哥氏力有关的项，它总是包含两个不同关节速度的乘积.:n1 与重力加速度有关的项,只与 有关，与它的导数无关 :nn 质量矩阵,的函数.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.5 6.5 操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构 :n1 Corio 3.位形空间方程 将速度项写成另一种形式:-nn(n-1)/2 哥氏力系数矩阵.-nn 离心力系数矩阵.动力学方程随着操作臂的运动不断更新.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.5 6.5 操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构 3.位形空间方程第 6 章:操作臂动力学 4.Inclusion of nonrigid body effects It is important to realize that the dynamic equations we have derived do not encompass all the effects acting on a manipulator.They include only these forces which arise from rigid body mechanism.The important source of forces that are not included is friction.The forces due to friction can actually be quite largeperhaps equaling 25%of the torque required to move the manipulator in typical situations.Viscous friction:is proportional to the velocity of joint motion:Coulomb friction:is constant except for a sign dependence on the joint velocity:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.5 6.5 操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构 4.Inclusion of nonrigid b A reasonable model is to include both:Friction also diaplays a dependence on the joint position.A major cause of this effect might be gears that are not perfectly roundtheir eccentricity would cause friction.So a fairly complex friction model:So the more complete manipulators model:We dont consider bending effects(which give rise to resonances),it is extremely difficult to model.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.5 6.5 操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构操作臂动力学方程的结构 A reasonable model 拉格朗日力学是基于能量项对系统变量及时间拉格朗日力学是基于能量项对系统变量及时间拉格朗日力学是基于能量项对系统变量及时间拉格朗日力学是基于能量项对系统变量及时间的微分的，运用该方法比运用牛顿力学更繁琐，但的微分的，运用该方法比运用牛顿力学更繁琐，但的微分的，运用该方法比运用牛顿力学更繁琐，但的微分的，运用该方法比运用牛顿力学更繁琐，但随着系统复杂程度的增加，运用拉格朗日力学将变随着系统复杂程度的增加，运用拉格朗日力学将变随着系统复杂程度的增加，运用拉格朗日力学将变随着系统复杂程度的增加，运用拉格朗日力学将变得相对简单。得相对简单。得相对简单。得相对简单。第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 拉格朗日力学是基于能量项对系统变量及时第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程L L是拉格朗日函数，是拉格朗日函数，K K是系统动能，是系统动能，P P是系统势能是系统势能式中式中式中式中F F是线运动中的所有外力之和，是线运动中的所有外力之和，是线运动中的所有外力之和，是线运动中的所有外力之和，T T是转动中的所有外力矩之和，是转动中的所有外力矩之和，是转动中的所有外力矩之和，是转动中的所有外力矩之和，X X是系统变量。是系统变量。是系统变量。是系统变量。第 6 章:操作臂动力学 6.6 拉格朗日方程L是拉格朗第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程第 6 章:操作臂动力学 6.6 拉格朗日方程第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程第 6 章:操作臂动力学 6.6 拉格朗日方程 操作臂的动能表达式:整个操作臂的动能是各个连杆动能之和:操作臂的动能可以描述为关节位置和速度的标量函数：操作臂的质量矩阵一定是正定矩阵第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 操作臂的动能表达式:第 6 章:操作臂 The potential energy of the ith link can be expressed as:where is the 31 gravity vector,is the vector locating the center of mass of the link,and is a constant chosen so that the minimum value is zero.The total potential energy stored in the manipulator is the sum of the potential energy in the individual links:We see that the potential energy of a manipulator can be described by a scalar formula as a function of joint position.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 The potential energy The Lagrangian dynamic formulation provides a means of deriving the equations of motion from a scalar function called the Lagrangian:The equations of the motion for the manipulator are then given by:where is the n1 vector of actuator torques.In the case of a manipulator,this equation becomes:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 The Lagrangian dynami Example:The links of an RP manipulator have inertia tensors:and total mass and .The center of mass of link1 is located at a distance from the joint-1 axis,and the center of mass of link2 is at the variable distance from the joint-1 axis.Use Lagrangian dynamics to determine the equation of the motion for this manipulator.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 Example:The links of an Write the kinemic energy of link 1 as:the kinetic energy of link 2 as:Hence,the totle kinetic energy is given by:Write the potential energy of link 1 as:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 Write the kinemic energy Potential energy of link 2 as:Total potential energy is given by:Then第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 Potential energy of link Finally:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 第 6 章:操作臂动力学 6.6 拉格朗日方第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程第 6 章:操作臂动力学 6.6 拉格朗日方程 We developed dynamic equations in joint space because we could use the serial-link nature of the mechanism to advantage in deriving the equations.In this section,we discuss the formulation of the dynamic equations that relate acceleration of the end-effector expressed in Cartesian space to Cartesian forces and moments acting at the end-effector.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.6 6.6 拉格朗日方程拉格朗日方程拉格朗日方程拉格朗日方程 We developed dynamic e 1.笛卡尔状态空间方程 应用笛卡尔变量的一般形式建立操作臂的动力学方程:-F 作用于机器人末端的力和力矩矢量 -能够恰当表达末端执行器位姿的笛卡尔矢量.-笛卡尔质量矩阵.-笛卡尔空间的速度项矢量.-笛卡尔空间的重力项矢量.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.7 6.7 笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程 1.笛卡尔状态空间方程第 6 章:操作臂动力学 F用关节驱动力表示:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.7 6.7 笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程 F用关节驱动力表示:第 6 章:操作臂动力学 6 Substituting:The expressions for the terms in Cartesian dynamics:Note that,the Jacobian is written in the same frames as ,the choice of this frame is arbitrary.When the manipulator approaches a singularity,certain quantities in the Cartesian dynamics become infinite.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.7 6.7 笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程 Substituting:第 6 章:操作臂动力 例子：两连杆平面机械臂的笛卡尔空间形式的动力学方程.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.7 6.7 笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程 例子：两连杆平面机械臂的笛卡尔空间形式的动力学方程 We can get:When ,the manipulator is in a singular position.For example,when ,the effective Cartesian mass of the end-effector becomes infinite in the direction of the link-2 tip frame.In general,at a singular configuration there is a certain direction,the singular direction in which motion is impossible,but general motion in the subspace“orthgonal”to this direction is possible.第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.7 6.7 笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程笛卡尔状态空间方程 We can get:第 6 章:操作臂动力学 2.笛卡尔位形空间的力矩方程 利用笛卡尔空间动力学方程写出等价的关节力矩:改写为:where is a matrix of Coriolis coefficients.is a matrix of centrifugal coefficients.Note that,is the same as in the joint-space equation,but in general:第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 6.8 6.8 笛卡尔位形空间的力矩方程笛卡尔位形空间的力矩方程笛卡尔位形空间的力矩方程笛卡尔位形空间的力矩方程 2.笛卡尔位形空间的力矩方程 第 课后题课后题课后题课后题P157,6.20P157,6.20：用拉格朗日法推导两自由度机器人手臂的运动方程，连杆的质心位于连杆的中心，其质量分别为 和 ，转动惯量分别为 和 .第第第第 6 6 章章章章:操作臂动力学操作臂动力学操作臂动力学操作臂动力学 练习：练习：练习：练习：课后题P157,6.20：第 6 章:操作
展开阅读全文