速度运动学雅可比矩阵.docx
《速度运动学雅可比矩阵.docx》由会员分享,可在线阅读,更多相关《速度运动学雅可比矩阵.docx(6页珍藏版)》请在冰豆网上搜索。
速度运动学雅可比矩阵
第4章速度运动学——雅可比矩阵
在数学上,正运动学方程在笛卡尔位置和姿态空间与关节位置空间之间定义了一个函数,速度之间的关系由这个函数的雅可比矩阵来决定。
雅可比矩阵出现在机器人操作的几乎各个方面:
规划和执行光滑轨迹,决定奇异位形,执行协调的拟人动作,推导运动的动力学方程,力和力矩在末端执行器和机械臂关节之间的转换。
1.角速度:
固定转轴情形
kθ
ω=(k是沿旋转轴线方向的一个单位向量,θ是角度θ对时间的倒数)2.反对称矩阵
一个nn⨯的矩阵S被称为反对称矩阵,当且仅当0=+SST
我们用3(so表示所有
33⨯反对称矩阵组成的集合。
如果3(soS∈,反对称矩阵满足0=+jiijss3,2,1,=ji,所以iiS=0,S仅包含三个独立项,并且每个33⨯的反对称矩阵具有下述形式:
⎥⎥⎥⎦
⎤⎢⎢⎢⎣⎡---=00
01
2
13
23ssssssS如果T
zyxaaaa,,(=是一个3维向量,我们将对应的反对称矩阵(aS定义为如下形式:
⎥⎥⎥⎦
⎤⎢⎢⎢⎣
⎡---=000
(x
yxz
yzaaaaaaaS反对称矩阵的性质
1)(((bSaSbaSβαβα+=+向量a、b属于3
R,α、β为标量
2)papaS⨯=(向量a、b属于3
R,pa⨯表示向量叉乘
3)((RaSRaRST
=,左侧表示矩阵(aS的一个相似变换,这个公式表明:
(aS在坐标系中经过R旋转操作的矩阵表示与反对称矩阵(aSR相同,其中(aSR对应于向量a被转过R这种情形。
4)对于一个nn⨯的反对称矩阵S,以及任何一个向量n
RX∈,有0=SXXT
旋转矩阵的导数
(θθ
SRRdd
=公式表明:
计算旋转矩阵的R的导数,等同于乘以一个反对称矩阵S的矩阵乘法操作。
3.角速度:
一般情况
((((tRtwStR
=,其中,矩阵((twS是反对称矩阵,向量(tw为t时刻旋转坐标系相对于固定坐标系上的点p。
4.角速度求和
假定我们有112010...-=nnnRRRR,则0
0,00(n
nnRSRω=,其中0,104
303
202,10
1,01,10134,30323,20212,10101,00,0......n
nnn
nnnRRRR----+++++=+++++=ω
ω
ω
ωωωωωωωω
(0
2,1ω表示对应于1
2R导数的角速度在坐标系0000zyxo中的表达式)
5.移动坐标系上点的线速度
vroRpSopRp
+⨯=+=+=ωω110(其中,1
Rpr=是从1o到p的向量在坐标系0000zyxo的姿态中的表达式,v是原点1o运
动的速度。
6.雅可比矩阵的推导
当机器人运动时,关节变量iq以及末端执行器的位置0no和姿态0
nR都将为时间的函数。
q
J=ξ其中,ξ和J由下式给出
⎥⎦
⎤⎢⎣⎡=00
nnvωξ和⎥⎦⎤⎢⎣⎡=wvJJJ
向量ξ有时被称为体速度。
矩阵J被称为机械臂的雅可布矩阵。
角速度:
末端执行器相对于基座坐标系的总的角速度0
nω:
011
01
01
22110
...-=-∑=+++=iin
iinnnn
zqkRqkRqkq
ρρρρω其中,关节i为转动时,iρ等于1,;而关节i为平动时,iρ等于0。
这是因为
kRzii0101--=,当然,Tkz1,0,0(0
0==。
所以...(101-=nnwzzJρρ
线速度:
i
n
viqoJ∂∂=0,雅可比矩阵的第i列可以通过下列方式生成:
固定除第i个关节之外的所有关节,同时以单位速度驱动第i个关节。
平动关节:
1-=ivzJi
转动关节:
(11---⨯=inivoozJi
小结:
雅可比矩阵的上半部分vJ由下式给出:
...(1nvvvJJJ=
其中,矩阵的第i列ivJ为
(
⎩
⎨⎧-⨯=---izioozJiinivi对于平动关节对于转动关节111
雅可比矩阵的下半部分为
...(1nJJJωωω=
其中,矩阵的第i列⎩⎨
⎧=-i
i
zJii对于平动关节对于转动关节0
1
ω
计算雅可比矩阵仅需知道单位向量iz以及原点noo,...,1的坐标。
iz相对于基座坐标系的坐标,可由0
iT第3列中的3个元素给出,同时io由0
iT第4列中的3个元素给出。
7.工具速度
末端执行器和工具坐标系之间的固定空间关系由下列恒定齐次变换矩阵给出:
⎥
⎦
⎤⎢⎣⎡=106
dRTtool由于两个坐标系之间的刚性连接,工具坐标系的角速度与末端执行器坐标系的角速度相等。
如果末端执行器坐标系以TTTv,(66ωξ=的体速度运动,那么工具坐标系的原点(它被
刚性固连到末端执行器坐标系中)的线速度由下式给出:
rvvtool⨯+=66ω,r是从末端执行器坐标系原点到工具坐标系原点的向量。
8.分析雅可比矩阵
前面推导的雅可比矩阵有时称为几何雅可比矩阵,这是为了区别于分析雅可比矩阵,后者表示为(qJa,它基于对末端执行器姿态的最小表示,令
⎥⎦
⎤
⎢⎣⎡=((qqdXα表示末端执行器的姿态,其中,(qd是从基座坐标系原点到末端执行器坐标系原点的一般向量,α表示末端执行器坐标系相对于基座坐标系的姿态的最小表示。
分析雅可比矩阵(qJa可以根据几何雅可比计算如下
qqJaBIdaBIBd
vqqJaa((00(00((⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=αα
αω(条件:
0(det≠αB)
9.奇点
所有可能的末端执行器速度是雅可比矩阵向量的线性组合:
nnqJqJq
J+++=...2211ξ矩阵的秩(rank)等于矩阵中线性独立的列(或行)的数目。
因此,当6=rankJ,末端执行器可以以任意速度运行。
与矩阵(qJ的秩小于其最大值情况相对应的位形被称为奇点或奇异位型。
识别机械臂的奇点很重要,其原因如下:
对那些带有球型手腕机械臂的奇异位形进行解耦,即分解为两个更简单的问题。
第一个问题是确定所谓的手臂奇点,也就是由于手臂(包括前三个或更多连杆)运动而产生的奇点;第二个问题是确定由球型手腕运动而引起的手腕奇点。
如果机械臂由一个3自由度手臂和一个3自由度球型手腕构成,我们将雅可比矩阵J分解成如下33⨯的矩阵块:
⎪⎪⎭
⎫
⎝⎛==22122111||(JJJJJJJQP
因此,机械臂奇异位形的集合是满足0det11=J的手臂位形集合以及满足0det22=J的手腕位形集合的并集。
任何两个转动关节轴共线时,都将会产生奇点,这是因为两个转角相等但方向相反的旋转所对应的综合结果是末端执行器保持不动。
10.静态力/力矩关系
令T
zyxzyxnnnFFFF,,,,,(=表示末端执行器的力和力矩向量。
令τ表示对应的关节力矩向量。
那么,F和τ之间可以由下式联系起来:
FqJT(=τ
其中,(qJT
是机械臂雅可比矩阵的转置。
11.逆速度和加速度
逆速度问题是指,求解生成期望末端执行器速度所需的关节速度q
ξ1-=Jq
对于6自由度机械臂,逆速度和逆加速度方程可被写为
qqJdtdqqJq
aa⎪⎭
⎫
⎝⎛+=((以及
é&&ædöù&&=Ja(q-1êX&úq-çJa(q÷qèdtøûë上述公式成立的条件是:
detJa(q¹0