机器人的两种表示法—DH参数与POE参数
前言
上一篇我们主要讲解了改进DH参数法表示机器人,这次我们讲一下POE参数法表示机器人
B、POE参数法
1984年Brockett介绍了POE公式,针对开链机器人,只需要确定基坐标系与末端坐标系,用空间6维旋量来表示每个关节。
针对旋量:记录三维空间中的单位向量
ω
\omega
ω表示关节轴方向,三维空间中取关节轴上一点p,计算关节轴三维空间中的速度
ν
=
p
×
ω
\nu=p×\omega
ν=p×ω。注意,所有参数都是相对于基坐标来计算的。
关节旋量是
4
×
4
4×4
4×4的矩阵,根据李代数
s
e
3
se3
se3可得
ξ
^
=
[
ω
^
ν
0
0
]
\hat\xi=\begin{bmatrix}\hat\omega & \nu \\ 0 & 0\\ \end{bmatrix}
ξ^=[ω^0ν0] 我们给出机器人正运动学POE公式
T
r
a
n
s
=
e
x
p
(
ξ
^
1
q
1
)
e
x
p
(
ξ
^
2
q
2
)
.
.
.
e
x
p
(
ξ
^
n
q
n
)
e
x
p
(
ξ
^
T
)
Trans=exp(\hat\xi_1q_1)exp(\hat\xi_2q_2)...exp(\hat\xi_nq_n)exp(\hat\xi T)
Trans=exp(ξ^1q1)exp(ξ^2q2)...exp(ξ^nqn)exp(ξ^T) 可以看到我们把每个机器人的关节轴都用旋量表示,进行的齐次矩阵连乘。