机器人及其控制第四章.docVIP

第五章：预备知识 向量a，b相乘 可以表示为 从而为线性算子。而一般称为角速度矩阵。 定理（夏莱定理）刚体最一般的位移可以分解为随任选基点的平动位移和绕通过基点的某个轴的转动。选择刚体上不同点为基点，这种分解不唯一；选择不同的基点时平动位移的长度和方向将改变，而转动轴的方向和转角不依赖于基点的选择。 定义5.1 中的运动是一个可微映射 其中是实轴上的一个区间，而导数 称为点的速度矢量。 二阶导数 称为点的加速度矢量。 定理5.2（惠更斯定理）存在唯一的刚体角速度的向量， 使刚体上P点的速度为可以写成 其中是基点的速度，向量不依赖于基点的选择。 证明（略证）： 因为 求导 得到 两边求转置 从而其为反对称矩阵 从而 从而证明下面的Euler公式（定点转动）： 推论5.2（绕固定轴旋转的角速度计算公式）见课本 证明：这个推论是建立关于角速度矢量的物理概念，根据第二章，有 其中 定义旋转矩阵的导数 把写成两部分 因此有 即 然后进行角度的微分变换，得到 代入得到 因此有 其中 因此角速度的物理意义是：在任一时刻，旋转坐标系方位的变化可以看作绕某个轴的旋转。 复合运动基本定义：设为固定参考系，而设为运动参考系，设点P在空间中运动，它相对于坐标系的运动为相对运动，而坐标系相对于坐标系的运动为牵连运动，而点P对于坐标系的运动为绝对运动。 定理5.3（速度合成定理）点的绝对速度等于牵连速度与相对速度之和。 即 推论：点的绝对速度等于牵连速度和相对速度之和。 刚体的复合运动 设刚体相对坐标系运动，而坐标系本身又相对固定坐标系运动，也就是说，刚体相对坐标系作复合运动。类似可定义n个运动合成的复合运动。 定理5.4（瞬时平动的合成）设是相对坐标系的平动速度，而设是坐标系相对于坐标系的平动速度。选择刚体上任意点P来求其绝对速度为 对于n个运动的情况，类似的可以得到平动速度： 定理5.5（瞬时定轴转动的合成）设刚体相对坐标系以瞬时角速度转动，而坐标系相对于坐标系以瞬时角速度转动。则刚体的角速度为 对于n个运动的情况，类似的可以得到等价的瞬时转动角速度： 定义5.1：对于质点系相对于固定笛卡尔坐标系运动，对向径和速度的限制（一般称为运动学限制）不因受力而改变，称为约束。如果系统不受约束，则系统称为自由，当存在一个或多个约束时系统称为非自由的。 约束一般表示为 虚位移：质点在某时刻某位置所假象的能满足约束条件的无限小可能位移。 注意：实位移和虚位移的区别。 双面理想约束： D Alembert原理： 根据第二定律，可得 这个原理称为D Alembert原理。一般称为惯性力。 定理5.6（动力学普遍方程，D Alembert-Lagrange原理）在双面理想约束下，研究N个质点组成的系统，设和分别是作用在质点上的主动方的合力和约束合力，于是得到如下方程： 这个方程称为动力学普遍方程。 定理5.7（静力学普遍方程，D Alembert-Lagrange原理） 理想双面约束允许的内，可能平衡状态是在时间内的真实平衡状态的充分必要条件是，对于该时间内的任意时刻主动力在任意虚位移上所做的元功为零 这个方程称为虚功原理。 证明：必要性，由动力学普遍方程，因为加速度为零。 因而得到静力学方程。 充分性，假设，则有 即 这表明动能不会增加，系统处于平衡状态。 定理5.7（刚体平衡的充要条件）刚体在内平衡的充要条件是在初始时刻刚体静止，主向量和对任意选取基点的主力矩在内等于零，即 证明：因为刚体是定常系统，所以在时间段dt内的真实位移就是虚位移。因此作用在刚体上的力系在虚位移上所做的元功为 其中为基点速度，是刚体在时刻的角速度。因为和是任意的，因为由静力学普遍方程，可知结论成立。 张量 定义：N阶张量定义为个下标，即 即N阶张量为N元函数。 张量内积：将M阶张量A的一个指标和N阶张量B的一个指标取成重复指标，并对该重复指标求和（称为指标缩并），得到一个M+N-2阶张量C。 Jacobi矩阵的数学求法 即 则 可得 还原为 其中 因为 所以 即 其中 雅克比矩阵的数学求解方法： 考虑齐次矩阵 通过R求角速度，上面已经求出 设 则 其中 令 则 即雅克比矩阵已经求出。 Jacobian矩阵 syms x y z; f=[x*y*z;y;x+z]; v=[x y z]; R=jacobian(f,v) R = [ y*z, x*z, x*y] [ 0, 1, 0] [ 1,