速度运动学-雅可比矩阵.docxVIP

速度运动学——雅可比矩阵

在数学上，正运动学方程在笛卡尔位置和姿态空间与关节位置空间之间定义了一个函数，速度之间的关系由这个函数的雅可比矩阵来决定。

雅可比矩阵出现在机器人操作的几乎各个方面：规划和执行光滑轨迹，决定奇异位形，执行协调的拟人动作，推导运动的动力学方程，力和力矩在末端执行器和机械臂关节之间的转换。

角速度：固定转轴情形

（是沿旋转轴线方向的一个单位向量，是角度对时间的倒数）

反对称矩阵

一个的矩阵被称为反对称矩阵，当且仅当,我们用表示所有反对称矩阵组成的集合。

如果，反对称矩阵满足，所以=0，仅包含三个独立项，并且每个的反对称矩阵具有下述形式：

如果是一个3维向量，我们将对应的反对称矩阵定义为如下形式：

反对称矩阵的性质

向量、属于，、为标量

向量、属于，表示向量叉乘

，左侧表示矩阵的一个相似变换，这个公式表明：在坐标系中经过旋转操作的矩阵表示与反对称矩阵相同，其中对应于向量被转过这种情形。

对于一个的反对称矩阵,以及任何一个向量，有

旋转矩阵的导数

公式表明：计算旋转矩阵的的导数，等同于乘以一个反对称矩阵的矩阵乘法操作。

角速度：一般情况

，其中，矩阵是反对称矩阵，向量为时刻旋转坐标系相对于固定坐标系上的点。

角速度求和

假定我们有，则，其中

（表示对应于导数的角速度在坐标系中的表达式）

移动坐标系上点的线速度

其中，是从到的向量在坐标系的姿态中的表达式，是原点运动的速度。

雅可比矩阵的推导

当机器人运动时，关节变量以及末端执行器的位置和姿态都将为时间的函数。

其中，和由下式给出

和

向量有时被称为体速度。矩阵被称为机械臂的雅可布矩阵。

角速度：

末端执行器相对于基座坐标系的总的角速度：

其中，关节为转动时，等于1,；而关节为平动时，等于0。这是因为

，当然，。

所以

线速度：

，雅可比矩阵的第列可以通过下列方式生成：固定除第个关节之外的所有关节，同时以单位速度驱动第个关节。

平动关节：

转动关节：

第二个问题是确定由球型手腕运动而引起的手腕奇点。

如果机械臂由一个3自由度手臂和一个3自由度球型手腕构成，我们将雅可比矩阵分解成如下的矩阵块：

因此，机械臂奇异位形的集合是满足的手臂位形集合以及满足的手腕位形集合的并集。

任何两个转动关节轴共线时，都将会产生奇点，这是因为两个转角相等但方向相反的旋转所对应的综合结果是末端执行器保持不动。

静态力/力矩关系

令表示末端执行器的力和力矩向量。令表示对应的关节力矩向量。那么，和之间可以由下式联系起来：

其中，是机械臂雅可比矩阵的转置。

逆速度和加速度

逆速度问题是指，求解生成期望末端执行器速度所需的关节速度

对于6自由度机械臂，逆速度和逆加速度方程可被写为

以及

上述公式成立的条件是：