雅可比矩阵小结
(1)描述末端速度与关节速度的变换关系。
雅可比矩阵描述机器人末端线速度和角速度与关节速度的变换关系。计算雅可比矩阵的其中一种方法是从线速度和角速度出发,推导得到。
p
e
˙
=
∑
i
=
1
n
∂
p
e
∂
q
i
q
˙
i
=
∑
i
=
1
n
J
P
i
q
i
w
e
=
w
n
=
∑
i
=
1
n
J
O
i
q
˙
i
\dot {\mathbf p_e}=\sum_{i=1}^n{\frac{\partial \mathbf p_e}{\partial q_i}\dot q_i}=\sum_{i=1}^n \mathbf J_{P_i}q_i\\ \mathbf w_e=\mathbf w_n=\sum_{i=1}^n\mathbf J_{O_i}\dot q_i
pe˙=i=1∑n∂qi∂peq˙i=i=1∑nJPiqiwe=wn=i=1∑nJOiq˙i
按照标准D-H建模,雅可比矩阵可以写成
J
=
[
J
P
J
O
]
=
[
J
P
1
J
P
n
⋯
J
O
1
J
O
n
]
J=\left[ \begin{matrix} J_P\\ J_O \end{matrix}\right]= \left[ \begin{matrix} J_{P1}& &J_{Pn}\\ & \cdots & \\ J_{O1} & &J_{On} \end{matrix}\right]\\
J=[JPJO]=⎣⎡JP1JO1⋯JPnJOn⎦⎤
其中,
(2)奇异点分析
令雅可比矩阵不满秩的位形称为运动学奇异点。行列式等于0,不可逆,处于奇异位形。
通过雅可比矩阵行列式计算内部奇异点可能会很繁琐,而且对复杂结构不容易求解。对球形腕的机械手,有可能将奇点计算问题分解为两个问题(奇点解耦)。
- 前3个或更多连杆引起的臂奇点的计算。
- 腕关节运动引起的腕奇点的计算。
例如,考虑六关节机械臂,雅可比矩阵可分解为4块,每个分块为(
3
×
3
3\times3
3×3)矩阵:
J
=
[
J
11
J
12
J
21
J
22
]
\mathbf J=\left[ \begin{matrix} \mathbf J_{11} &\mathbf J_{12}\\ \mathbf J_{21} &\mathbf J_{22} \end{matrix}\right]
J=[J11J21J12J22]
其中,因为外部的三个关节都是转动,右边两个分块的表达式为
J
12
=
[
z
3
×
(
p
e
−
p
3
)
z
4
×
(
p
e
−
p
4
)
z
5
×
(
p
e
−
p
5
)
]
J
22
=
[
z
3
z
4
z
5
]
\mathbf J_{12}=\left[ \begin{matrix} \mathbf z_3\times (\mathbf p_e-\mathbf p_3) &\mathbf z_4\times(\mathbf p_e-\mathbf p_4) &\mathbf z_5\times(\mathbf p_e-\mathbf p_5) \end{matrix}\right]\\ \mathbf J_{22}=\left[ \begin{matrix} \mathbf z_3&\mathbf z_4 &\mathbf z_5 \end{matrix}\right]
J12=[z3×(pe−p3)z4×(pe−p4)z5×(pe−p5)]J22=[z3z4z5]
运动学奇点是机械结构所固有的,与描述运动学的坐标系选择无关。因此,可以把末端执行器的原点选择在手腕的轴的交点上。选择
p
=
p
w
\mathbf p=\mathbf p_w
p=pw,有
J
12
=
[
0
0
0
]
\mathbf J_{12}=\left[ \begin{matrix} \mathbf 0&\mathbf 0 &\mathbf 0 \end{matrix}\right]
J12=[000]
全局雅可比就成为一个分块下三角矩阵。行列式计算为
det
(
J
)
=
det
(
J
11
)
det
(
J
22
)
\text {det}(\mathbf J)=\text {det}(\mathbf J_{11})\text {det}(\mathbf J_{22})
det(J)=det(J11)det(J22)
从而条件
det
(
J
11
)
=
0
\text{det}(\mathbf J_{11})=0
det(J11)=0
用于确定机械手奇点。
条件
det
(
J
22
)
=
0
\text{det}(\mathbf J_{22})=0
det(J22)=0
用以确定腕关节奇点。
(3)冗余性分析
机械臂关节空间维数n大于任务维数为m,称为冗余机械臂。雅可比矩阵可以分析机械臂的冗余性,如果行数小于列数,则机械臂存在冗余性。
(4) 雅可比矩阵的逆
使用数值法求机械臂逆解接时,通常需要计算雅可比矩阵的逆或伪逆。
(5)末端执行器的力与关节力矩的映射
末端执行器的力与关节力矩的映射的关系可以由雅可比矩阵的的转置确定。令
τ
\mathbf \tau
τ表示
(
n
×
1
)
(n\times 1)
(n×1)关节力矩向量,
f
e
\mathbf f_e
fe表示
(
r
×
1
)
(r\times 1)
(r×1)末端执行器力向量,其中r表示感兴趣的操作空间的维数。那么有
τ
=
J
T
(
q
)
f
e
\mathbf \tau=\mathbf J^T(\mathbf q)\mathbf f_e
τ=JT(q)fe
参考文献
布鲁诺・西西里安诺. 机器人学:建模、规划与控制[M]. 西安交通大学出版社, 2015.