速度运动学-雅可比矩阵

第4章 速度运动学雅可比矩阵在数学上，正运动学方程在笛卡尔位置和姿态空间与关节位置空间之间定义了一个函数，速度之间的关系由这个函数的雅可比矩阵来决定。雅可比矩阵出现在机器人操作的几乎各个方面：规划和执行光滑轨迹，决定奇异位形，执行协调的拟人动作，推导运动的动力学方程，力和力矩在末端执行器和机械臂关节之间的转换。 1. 角速度：固定转轴情形（是沿旋转轴线方向的一个单位向量，是角度对时间的倒数）2. 反对称矩阵一个的矩阵被称为反对称矩阵，当且仅当,我们用表示所有反对称矩阵组成的集合。如果，反对称矩阵满足 ，所以=0，仅包含三个独立项，并且每个的反对称矩阵具有下述形式：如果是一个3维向量，我们将对应的反对称矩阵定义为如下形式：反对称矩阵的性质1） 向量、属于，、为标量2） 向量、属于，表示向量叉乘3） ，左侧表示矩阵的一个相似变换，这个公式表明：在坐标系中经过旋转操作的矩阵表示与反对称矩阵相同，其中对应于向量被转过这种情形。4） 对于一个的反对称矩阵,以及任何一个向量，有 旋转矩阵的导数 公式表明：计算旋转矩阵的的导数，等同于乘以一个反对称矩阵的矩阵乘法操作。3. 角速度：一般情况，其中，矩阵是反对称矩阵，向量为时刻旋转坐标系相对于固定坐标系上的点。4. 角速度求和假定我们有，则，其中（表示对应于导数的角速度在坐标系中的表达式） 5. 移动坐标系上点的线速度其中，是从到的向量在坐标系的姿态中的表达式，是原点运动的速度。6. 雅可比矩阵的推导当机器人运动时，关节变量以及末端执行器的位置和姿态都将为时间的函数。其中，和由下式给出 和 向量有时被称为体速度。矩阵被称为机械臂的雅可布矩阵。角速度：末端执行器相对于基座坐标系的总的角速度：其中，关节为转动时，等于1,；而关节为平动时，等于0。这是因为，当然，。所以 线速度：，雅可比矩阵的第列可以通过下列方式生成：固定除第个关节之外的所有关节，同时以单位速度驱动第个关节。平动关节：转动关节：小结：雅可比矩阵的上半部分由下式给出：其中，矩阵的第列为 雅可比矩阵的下半部分为其中，矩阵的第列计算雅可比矩阵仅需知道单位向量以及原点的坐标。相对于基座坐标系的坐标，可由第3列中的3个元素给出，同时由第4列中的3个元素给出。7. 工具速度末端执行器和工具坐标系之间的固定空间关系由下列恒定齐次变换矩阵给出：由于两个坐标系之间的刚性连接，工具坐标系的角速度与末端执行器坐标系的角速度相等。如果末端执行器坐标系以的体速度运动，那么工具坐标系的原点（它被刚性固连到末端执行器坐标系中）的线速度由下式给出：，是从末端执行器坐标系原点到工具坐标系原点的向量。8. 分析雅可比矩阵前面推导的雅可比矩阵有时称为几何雅可比矩阵，这是为了区别于分析雅可比矩阵，后者表示为，它基于对末端执行器姿态的最小表示，令表示末端执行器的姿态，其中，是从基座坐标系原点到末端执行器坐标系原点的一般向量，表示末端执行器坐标系相对于基座坐标系的姿态的最小表示。分析雅可比矩阵可以根据几何雅可比计算如下（条件：）9. 奇点所有可能的末端执行器速度是雅可比矩阵向量的线性组合：矩阵的秩（rank）等于矩阵中线性独立的列（或行）的数目。因此，当，末端执行器可以以任意速度运行。与矩阵的秩小于其最大值情况相对应的位形被称为奇点或奇异位型。识别机械臂的奇点很重要，其原因如下：对那些带有球型手腕机械臂的奇异位形进行解耦，即分解为两个更简单的问题。第一个问题是确定所谓的手臂奇点，也就是由于手臂（包括前三个或更多连杆）运动而产生的奇点；第二个问题是确定由球型手腕运动而引起的手腕奇点。如果机械臂由一个3自由度手臂和一个3自由度球型手腕构成，我们将雅可比矩阵分解成如下的矩阵块：因此，机械臂奇异位形的集合是满足的手臂位形集合以及满足的手腕位形集合的并集。任何两个转动关节轴共线时，都将会产生奇点，这是因为两个转角相等但方向相反的旋转所对应的综合结果是末端执行器保持不动。10. 静态力/力矩关系令表示末端执行器的力和力矩向量。令表示对应的关节力矩向量。那么，和之间可以由下式联系起来：其中，