机器人学导论——雅可比:速度和静力

一 刚体的线速度和角速度

1.1 位置矢量的导数

位置矢量BQ的速度可以用BQ的导数表示,当然,这边是基于坐标系B来描述的。
请添加图片描述
另一种说法是:位置矢量的速度可以看作用位置矢量描述的空间的一点的线速度。
上述的速度矢量在坐标系A中的描述为
请添加图片描述
也可以写作
请添加图片描述

经常讨论的是一个坐标系原点相对于某个常见的世界参考坐标系的速度,而不考虑相对于任意坐标系中一般点的速度。对于这种特殊情况,定义一个缩写符号
在这里插入图片描述
式中的点为坐标系{C}的原点,参考坐标系为{U}。例如,用符号vc表示坐标系{C}原点的速度;Avc 是坐标系{C}的原点在坐标系{A}中表示的速度(尽管微分是相对于坐标系{U}进行的)。

1.2 角速度矢量

角速度描述了刚体的旋转运动,用符号Ω表示。
机器人学导论——雅可比:速度和静力_第1张图片
上图中的AΩB表示坐标系B相对于坐标系A的旋转。
角速度矢量的另一种表示为
在这里插入图片描述

1.3 线速度

我们知道,在任意时刻,机器人的每个连杆都具有一定的线速度和角速度,相邻连杆之间的速度和角速度该如何传递?或者说是,应该如何互相描述运动着的相邻连杆。
机器人学导论——雅可比:速度和静力_第2张图片

上图中,坐标系A规定为固定的参考坐标系,坐标系B被固定在一个刚体上,刚体是可移动的,在坐标系B中有一点Q,记作BQ,那么实际上也表示坐标系原点到点Q的矢量。
现在,我们想要描述点Q在坐标系A中的描述,如何实现?
坐标系{B}相对于坐标系{A}的位置用位置矢量APBORG和旋转矩阵ABR来描述。此时,假定方位ABR不随时间变化,则Q点相对于坐标系{A}的运动是由于APBORGBQ随时间的变化引起的。
下式中的第一项是坐标系B相对于坐标系A的移动速度,第二项是点Q在坐标系B中的移动速度映射到坐标系A中。当然前提是这边两个坐标系的姿态保证不变,否则就要涉及到角速度分量。

在这里插入图片描述

1.4 角速度

上面讨论了两坐标系的姿态保持不变情况下,移动刚体的线速度,现在讨论两坐标系相对线速度为0,原点重合的情况。
机器人学导论——雅可比:速度和静力_第3张图片
上图中,坐标系A规定为固定的参考坐标系,坐标系B原点与坐标系A原点重合。B被固定在一个刚体上,刚体是可绕原点旋转的,在坐标系B中有一点Q,记作BQ,坐标系B相对于坐标系A旋转的速度用矢量AΩB表示。
同样,我们想要描述点Q在坐标系A中的描述,如何实现?
假设从坐标系{B}看矢量Q是不变的,即
在这里插入图片描述
既然它相对于{B}不变,显然从坐标系{A}中看点Q的速度为旋转角速度AΩB。下图所示为用两个瞬时量表示矢量Q绕AΩB的旋转。这是从坐标系{A}中观测到的。.

机器人学导论——雅可比:速度和静力_第4张图片
我们可以想象,点Q在坐标系A中的表示下,是绕着AΩB旋转的,那么旋转的轨迹可以看作是一个圆,且矢量AQ与AΩB的夹角始终为θ。那么从轨迹的正上方向下看,可以得到下图所示的简图(记为平面O,平面O垂直于AΩB),Q(t+Δt)与Q(t)之间的距离为ΔQ,欧姆Δt为弧度。
机器人学导论——雅可比:速度和静力_第5张图片
ΔQ始终垂直于AΩBAQ,由于Δt足够小,ΔQ可以近似为弧长,那么由圆弧长计算公式,从上图可以得到:
在这里插入图片描述
等式两边同时除以Δt可以得到
在这里插入图片描述
这边利用到了等式
A V Q = Δ Q / Δ t ^{A}V_Q=ΔQ/Δt AVQ=ΔQ/Δt

∣ A Q ∣ ∣ A Ω B ∣ ⋅ s i n θ = A Ω B × A Q |^{A}Q||^{A}Ω_B|\cdot sinθ=^{A}Ω_B\times^{A}Q AQAΩBsinθ=AΩB×AQ
在一般情况下,矢量Q是相对于坐标系{B}变化的,因此要加上此分量,得
在这里插入图片描述

在这里插入图片描述

1.5 联立线速度和角速度

假如两个坐标系原点不重合,同时又有相对移动,那么有
在这里插入图片描述

1.6 角速度矩阵

对于任何nxn的正交矩阵R,有
在这里插入图片描述
对其求导
在这里插入图片描述
在这里插入图片描述
定义
在这里插入图片描述
那么
在这里插入图片描述
S为反对称矩阵。因此正交矩阵的微分与反对称矩阵之间存在如下特性,可写为
在这里插入图片描述
假定固定矢量BP相对于坐标系{B}是不变的,在另一个坐标系{A}中的描述为
在这里插入图片描述
如果坐标系{B}是旋转的,AP 也是变化的,即使B为P常数,即
在这里插入图片描述

在这里插入图片描述
那么
在这里插入图片描述
在这里插入图片描述
式中用S的上下标表明它是与旋转矩阵ABR相关的反对称矩阵,为了便于理解的原因,因此这里所说的旋转矩阵通常称为角速度矩阵

1.7 角速度矢量

机器人学导论——雅可比:速度和静力_第6张图片
定义
机器人学导论——雅可比:速度和静力_第7张图片
容易证明
在这里插入图片描述
与3 x 3的角速度矩阵相对应的3 x 1矢量Ω称为角速度矢量。
因此联立1.7节的结论有
在这里插入图片描述
角速度矢量的物理意义是,在任一时刻,旋转坐标系方位的变化可以看作是绕某个轴 K ^ \hat{K} K^的旋转。这个瞬时转动轴,可作为单位矢量,与绕这个轴的旋转速度标量θ构成角速度矢量。
机器人学导论——雅可比:速度和静力_第8张图片
证明略。

关于瞬时转动轴 K ^ \hat{K} K^,在第二章的时候引入此概念, A K ^ = [ k x , k y , k z ] T ^A\hat K =[kx,ky,kz]^T AK^=[kxkykz]T

二 机器人的连杆运动

2.1 连杆间的速度“传递”

机器人一般都有一个参考坐标系{0},往往是位于机器人底座与大地的接触面和机器人一轴的原点重合。我们可以通过该基坐标系依次计算各连杆的速度。连杆 i + 1 i+1 i+1的速度就是连杆 i i i的速度加上那些附加到关节 i + 1 i+1 i+1上的新的速度分量。

  • 对于某一连杆本身,如下图所示,将机构的每一个连杆看作为一个刚体,可以用线速度矢量和角速度矢量描述其运动。
    机器人学导论——雅可比:速度和静力_第9张图片
  • 对于相邻连杆 i i i i + 1 i+1 i+1,如下图所示,连杆间的速度可以相互“传递”。
    当两个矢量都是相对于同一个坐标系时,那么这些角速度能够相加。因此,连杆 i + 1 i+1 i+1的角速度就等于连杆 i i i的角速度加上一个由于关节 i + 1 i+1 i+1的角速度引起的分量。
    机器人学导论——雅可比:速度和静力_第10张图片

2.1.1 连杆 i + 1 i+1 i+1 i i i中角速度的描述

在这里插入图片描述
等式右边的第二项用到了上面的 结论

即利用公式 Ω = θ ˙ K ^ Ω=\dotθ\hat {K} Ω=θ˙K^,这里的 K ^ \hat {K} K^ θ ˙ \dotθ θ˙下标是 i + 1 i+1 i+1,表示其是基于坐标系 i + 1 i+1 i+1描述的,再左乘旋转矩阵i+1iR就得到了“由于关节 i + 1 i+1 i+1的角速度引起的分量”。
那么我们就可以得到连杆 i + 1 i+1 i+1在坐标系 i i i中描述的角速度。
并且这里有
机器人学导论——雅可比:速度和静力_第11张图片
关于瞬时转动轴 K ^ \hat{K} K^,在第二章的时候引入此概念, A K ^ = [ k x , k y , k z ] T ^A\hat K =[kx,ky,kz]^T AK^=[kxkykz]T。上式选定的瞬时转动轴为坐标系 i + 1 i+1 i+1 Z Z Z轴,所以有 A Z ^ = [ 0 , 0 , 1 ] T ^A\hat Z =[0,0,1]^T AZ^=[001]T

2.1.2 连杆 i i i i + 1 i+1 i+1中角速度的描述

同理
在这里插入图片描述

2.1.3 连杆 i + 1 i+1 i+1 i i i中速度的描述

坐标系{ i + 1 i+1 i+1}原点的线速度等于坐标系{ i i i}原点的线速度加上一个由于连杆 i i i的角速度引起的新的分量。
1.5节里有公式
在这里插入图片描述
由于 i P i + 1 ^iP_{i+1} iPi+1在坐标系{i}中是常数,所以等式右边第二项就消失了。因此有
在这里插入图片描述

在这里插入图片描述

2.1.4 关节 i + 1 i+1 i+1为移动关节的情况

在这里插入图片描述
从一个连杆到下一个连杆依次应用这些公式,可以计算出最后一个连杆的角速度 N ω N ^N\omega_N NωN和线速度 N v N ^Nv_N NvN,注意,这两个速度是按照坐标系{N}表达的。在后面可以看到,这个结果是非常有用的。如果用基坐标系来表达角速度和线速度的话,就可以用 N 0 R ^0_NR N0R去左乘速度,向基坐标进行旋转变换。

三 雅可比

3.1 雅可比矩阵

雅可比矩阵是多元形式的导数。例如,假设有6个函数,每个函数都有6个独立的变量:
机器人学导论——雅可比:速度和静力_第12张图片
用矢量符号表示为
在这里插入图片描述
现在,如果想要计算出 y i y_i yi的微分关于 x j x_j xj的微分的函数,可简单应用多元函数求导法则计算,得到
机器人学导论——雅可比:速度和静力_第13张图片

在这里插入图片描述
上式中的 6 × 6 6 \times 6 6×6偏导数矩阵就是我们所说的雅可比矩阵 J J J。注意到,如果 f 1 ( X ) f_1(X) f1(X) f 6 ( X ) f_6(X) f6(X)都是
非线性函数,那么这些偏导数都是 x i x_i xi的函数,因此可以表示如下
在这里插入图片描述
将上式两端同时除以时间的微分,可以将雅可比矩阵看成是 X X X中的速度向 Y Y Y中速度的映射:
在这里插入图片描述
在任一瞬时, X X X都有一个确定的值, J ( X ) J(X) J(X)是个线性变换。 在每一个新时刻,如果 X X X改变,线性
变换也会随之而变。所以,雅可比是时变的线性变换。
在机器人学中,通常使用雅可比将关节速度与操作臂末端的笛卡儿速度联系起来,比如,
在这里插入图片描述
式中, Θ \Theta Θ是操作臂关节角矢量, v v v是笛卡儿速度矢量。我们给雅可比表达式附加了左上标,以此表示笛卡儿速度所参考的坐标系。
对于通常的6关节机器人,雅可比矩阵是 6 × 6 6\times6 6×6阶的矩阵, Θ ˙ \dot\Theta Θ˙ 6 × 1 6\times1 6×1维的, 0 v ^0v 0v 也是 6 × 1 6\times 1 6×1维的。这个 6 × 1 6\times 1 6×1笛卡儿速度矢量是由一个 3 × 1 3\times1 3×1的线速度矢量和一个 3 × 1 3\times1 3×1的角速度矢量组合起来的。
可以定义任何维数的雅可比矩阵(包括非方阵形式)。雅可比矩阵的行数等于操作臂在笛卡儿空间的自由度数量,雅可比矩阵的列数等于操作臂的关节数量。

3.2 雅可比矩阵参考坐标系的变换

已知坐标系{B}中的雅可比矩阵,即
在这里插入图片描述
我们关心的是给出雅可比矩阵在另一个坐标系{A}中的表达式。首先,注意到已知坐标系{B}中的 6 × 1 6\times1 6×1笛卡儿速度矢量可以通过如下变换得到相对于坐标系{A}的表达式
机器人学导论——雅可比:速度和静力_第14张图片
那么
在这里插入图片描述
最后可以得到
在这里插入图片描述
完成雅可比矩阵参考坐标系的变换

3.3 奇异性

假设我们需要控制机械臂末端以一个已知速度 v v v运动,如何反过来求得关节的角速度 Θ ˙ \dot \Theta Θ˙
可以利用下式得出
在这里插入图片描述
但是就会存在一个问题,如果保证雅可比矩阵可逆?如果不可逆,即矩阵奇异,此时关节速度趋于无穷大,是危险的。

大多数操作臂都有使得雅可比矩阵出现奇异的 Θ \Theta Θ值。这些位置就称为机构的奇异位形或简称奇异状态。所有操作臂在工作空间的边界都存在奇异位形,并且大多数操作臂在它们的工作空间内也有奇异位形。大致将它们分为两类

  1. 工作空间边界的奇异位形出现在操作臂完全展开或者收回使得末端执行器处于或非常接近工作空间边界的情况。
  2. 工作空间内部的奇异位形出现在远离工作空间的边界,通常是由于两个或两个以上的关节轴线共线引起的。

四 机械臂的静力

你可能感兴趣的:(机器人,其他)