Example 4:The exponential map of SO(3)
We have seen in Ex.3 that
R
˙
=
R
[
ω
]
×
∈
T
R
S
O
(
3
)
.
\dot R = R [ω]_× ∈ T_RSO(3).
R˙=R[ω]×∈TRSO(3).
For ω constant, this is an ordinary differential equation(ODE), whose solution is
R
(
t
)
=
R
0
∗
e
x
p
(
[
ω
]
×
t
)
R(t) = R0*exp([ω]_× t)
R(t)=R0∗exp([ω]×t). At the origin
R
0
=
I
R0 = I
R0=I we have the exponential map,
R
(
t
)
=
e
x
p
(
[
ω
]
×
t
)
∈
S
O
(
3
)
R(t) = exp([ω]_× t) \ \ \ \ \ ∈ SO(3)
R(t)=exp([ω]×t) ∈SO(3) .
We now define the vector
θ
≜
u
θ
≜
ω
t
∈
R
3
θ \triangleq uθ\triangleq ωt ∈ R^3
θ≜uθ≜ωt∈R3 as the integrated rotation in angle-axis form, with angle θ and unit axis u. Thus
[
θ
]
×
∈
s
o
(
3
)
[θ]_× ∈ so(3)
[θ]×∈so(3) is the total rotation expressed in the Lie algebra. We substitute it above. Then write the exponential as a power series,
R
=
e
x
p
(
[
θ
]
×
)
=
∑
k
θ
k
k
!
(
[
u
]
×
)
k
.
R = exp([θ]_×) = \sum_k\frac{θ^k}{k!}([u]_×)k.
R=exp([θ]×)=k∑k!θk([u]×)k.
In order to find a closed-form expression, we write down a few powers of [u]×,
[
u
]
×
0
=
I
,
[
u
]
×
1
=
[
u
]
×
[
u
]
×
2
=
u
u
t
−
I
,
[
u
]
×
3
=
−
[
u
]
×
,
[
u
]
4
×
=
−
[
u
]
×
2
,
⋅
⋅
⋅
[u]^0_× = I,\ \ \ \ \ \ [u]^1_× = [u]_× \\ [u]^2_× = uu^t − I,\ \ [u]^3_× = − [u]_× ,\\ [u]4× = − [u]^2_× ,\ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ · · ·
[u]×0=I, [u]×1=[u]×[u]×2=uut−I, [u]×3=−[u]×,[u]4×=−[u]×2, ⋅⋅⋅
and realize that all can be expressed as multiples of I,[u]_× or [u]^2_×. We thus rewrite the series as,
R
=
I
+
[
u
]
×
(
θ
−
1
3
!
θ
3
+
1
5
!
θ
5
−
…
…
)
+
[
u
]
×
2
(
1
2
θ
2
−
1
4
!
θ
4
+
1
6
!
θ
6
−
…
…
)
R = I + [u]_×(θ −\frac{1}{3!} θ^3 +\frac{1}{5!} θ^5-……)\\+ [u]_×^2(\frac{1}{2}θ^2 −\frac{1}{4!} θ^4 +\frac{1}{6!} θ^6-……)
R=I+[u]×(θ−3!1θ3+5!1θ5−……)+[u]×2(21θ2−4!1θ4+6!1θ6−……)
where we identify the series of sin θ and cos θ, yielding the closed form
R
=
e
x
p
(
[
u
θ
]
×
)
=
I
+
[
u
]
×
s
i
n
θ
+
[
u
]
×
2
(
1
−
c
o
s
θ
)
R = exp([uθ]×) = I + [u]_× sin θ + [u]^2_× (1−cos θ)
R=exp([uθ]×)=I+[u]×sinθ+[u]×2(1−cosθ)
This expression is the well known Rodrigues rotation formula. It can be used as the capitalized exponential just by doing
R
=
E
x
p
(
u
θ
)
=
e
x
p
(
[
u
θ
]
×
)
R = Exp(uθ) = exp([uθ]_×)
R=Exp(uθ)=exp([uθ]×)。
我们已经在 Ex3 中看到了
R
˙
=
R
[
ω
]
×
∈
T
R
S
O
(
3
)
\dot R = R [ω]_× ∈ T_RSO(3)
R˙=R[ω]×∈TRSO(3)
对于 ω 常数,这是一个ODE (常微分方程),其解为
R
(
t
)
=
R
0
∗
e
x
p
(
[
ω
]
×
t
)
R(t) = R0*exp([ω]_× t)
R(t)=R0∗exp([ω]×t)。 在
原点 R0 = I 我们有指数映射,
R
(
t
)
=
e
x
p
(
[
ω
]
×
t
)
∈
S
O
(
3
)
R(t) = exp([ω]_× t) \ \ \ \ \ ∈ SO(3)
R(t)=exp([ω]×t) ∈SO(3)
我们现在定义向量
θ
≜
u
θ
≜
ω
t
∈
R
3
θ \triangleq uθ\triangleq ωt ∈ R^3
θ≜uθ≜ωt∈R3 为角度轴形式的积分旋转,角度 θ 和单位轴 u。 因此
[
θ
]
×
∈
s
o
(
3
)
[θ]_× ∈ so(3)
[θ]×∈so(3)是李代数中表达的总旋转。 我们在上面替换它。 然后将指数写成幂级数,
R
=
e
x
p
(
[
θ
]
×
)
=
∑
k
θ
k
k
!
(
[
u
]
×
)
k
R = exp([θ]_×) = \sum_k\frac{θ^k}{k!}([u]_×)k
R=exp([θ]×)=k∑k!θk([u]×)k
为了找到一个封闭形式的表达式,我们写下 [u]× 的几个幂,
[
u
]
×
0
=
I
,
[
u
]
×
1
=
[
u
]
×
[
u
]
×
2
=
u
u
t
−
I
,
[
u
]
×
3
=
−
[
u
]
×
,
[
u
]
4
×
=
−
[
u
]
×
2
,
⋅
⋅
⋅
[u]^0_× = I,\ \ \ \ \ \ [u]^1_× = [u]_× \\ [u]^2_× = uu^t − I,\ \ [u]^3_× = − [u]_× ,\\ [u]4× = − [u]^2_× ,\ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ · · ·
[u]×0=I, [u]×1=[u]×[u]×2=uut−I, [u]×3=−[u]×,[u]4×=−[u]×2, ⋅⋅⋅
并意识到所有都可以表示为 I,[u]_× 或 [u]^2_× 的倍数。 因此,我们将其重写为,
R
=
I
+
[
u
]
×
(
θ
−
1
3
!
θ
3
+
1
5
!
θ
5
−
…
…
)
+
[
u
]
×
2
(
1
2
θ
2
−
1
4
!
θ
4
+
1
6
!
θ
6
−
…
…
)
R = I + [u]_×(θ −\frac{1}{3!} θ^3 +\frac{1}{5!} θ^5-……)\\+ [u]_×^2(\frac{1}{2}θ^2 −\frac{1}{4!} θ^4 +\frac{1}{6!} θ^6-……)
R=I+[u]×(θ−3!1θ3+5!1θ5−……)+[u]×2(21θ2−4!1θ4+6!1θ6−……)
通过 sin θ 和 cos θ 的序列形成的封闭形式
R
=
e
x
p
(
[
u
θ
]
×
)
=
I
+
[
u
]
×
s
i
n
θ
+
[
u
]
×
2
(
1
−
c
o
s
θ
)
R = exp([uθ]×) = I + [u]_× sin θ + [u]^2_× (1−cos θ)
R=exp([uθ]×)=I+[u]×sinθ+[u]×2(1−cosθ)
这个表达式就是众所周知的罗德里格斯旋转公式。 只需执行以下操作即可将其用作大写指数
R
=
E
x
p
(
u
θ
)
=
e
x
p
(
[
u
θ
]
×
)
R = Exp(uθ) = exp([uθ]_×)
R=Exp(uθ)=exp([uθ]×)。
Example 5: The unit quaternions group S3(cont.)
单位四元数群 S3(续)
In the group S3(recall Ex. 2 and see e.g. [8]), the time derivative of the unit norm condition
q
∗
q
=
1
q^∗q = 1
q∗q=1 yields
q
∗
q
˙
=
−
(
q
∗
q
˙
)
∗
.
q^*\dot q = −(q^*\dot q)^∗.
q∗q˙=−(q∗q˙)∗.
This reveals that
q
∗
q
˙
q^*\dot q
q∗q˙ is a pure quaternion (its real part is zero). Pure quaternions uv ∈ Hp have the form
u
v
=
(
i
u
x
+
j
u
y
+
k
u
z
)
v
=
i
v
x
+
j
v
y
+
k
v
z
uv = (iu_x + ju_y + ku_z)v = iv_x + jv_y + kv_z
uv=(iux+juy+kuz)v=ivx+jvy+kvz
where
u
≜
i
u
x
+
j
u
y
+
k
u
z
u\triangleq iu_x + ju_y + ku_z
u≜iux+juy+kuzis pure and unitary, v is the norm, and i, j, k are the generators of the Lie algebra
s
3
=
H
p
s^3 = H_p
s3=Hp. Re-writing the condition above we have,
q
˙
=
q
u
v
∈
T
q
S
3
\dot q = q uv \ \ \ \ \ ∈ T_qS^3
q˙=quv ∈TqS3
which integrates to
q
=
q
0
∗
e
x
p
(
u
v
t
)
q = q0* exp(uvt)
q=q0∗exp(uvt). Letting q0 = 1 and defining
φ
≜
u
φ
≜
u
v
t
φ\triangleq uφ\triangleq uvt
φ≜uφ≜uvt we get the exponential map,
q
=
e
x
p
(
u
φ
)
≜
∑
φ
k
k
!
u
k
∈
S
3
q=exp(uφ)\triangleq \sum\frac{ φ^k}{k!}u^k\ \ \ \ \ ∈ S^3
q=exp(uφ)≜∑k!φkuk ∈S3
The powers of u follow the pattern 1, u, −1, −u, 1, · · · .
Thus we group the terms in 1 and u and identify the series of cos φ and sin φ. We get the closed form
q
=
e
x
p
(
u
φ
)
=
c
o
s
(
φ
)
+
u
s
i
n
(
φ
)
,
q = exp(uφ) = cos(φ) + u sin(φ) ,
q=exp(uφ)=cos(φ)+usin(φ),
which is a beautiful extension of the Euler formula,exp(iφ) = cos φ+isin φ.
The elements of the Lie algebra φ = uφ ∈ s3 can be identified with the rotation vectorθ ∈ R3 trough the mappings hat and vee,
H
a
t
:
R
3
→
s
3
;
θ
→
θ
∧
=
2
φ
V
e
e
:
s
3
→
R
3
;
φ
→
φ
∨
=
θ
/
2
Hat : R^3 → s^3; θ→ θ^∧ = 2φ\\ Vee : s^3 → R^3; φ → φ^∨ = θ/2
Hat:R3→s3;θ→θ∧=2φVee:s3→R3;φ→φ∨=θ/2 ,
where the factor 2 accounts for the double effect of the quaternion in the rotation action, x’ = q x q∗. With this choice of Hat and Vee, the quaternion exponential
q
=
E
x
p
(
u
θ
)
=
c
o
s
(
θ
/
2
)
+
u
s
i
n
(
θ
/
2
)
q = Exp(uθ) = cos(θ/2) + u sin(θ/2)
q=Exp(uθ)=cos(θ/2)+usin(θ/2)
is equivalent to the rotation matrix R = Exp(uθ)
在群 S3(回忆例 2 并参见例 [8])中,单位范数条件
q
∗
q
=
1
q^∗q = 1
q∗q=1 的时间导数要求
q
∗
q
˙
=
−
(
q
∗
q
˙
)
∗
.
q^*\dot q = −(q^*\dot q)^∗.
q∗q˙=−(q∗q˙)∗.
这表明
q
∗
q
˙
q^*\dot q
q∗q˙ 是一个纯四元数(它的实部为零)。 纯四元数 uv ∈ Hp 具有形式
u
v
=
(
i
u
x
+
j
u
y
+
k
u
z
)
v
=
i
v
x
+
j
v
y
+
k
v
z
uv = (iu_x + ju_y + ku_z)v = iv_x + jv_y + kv_z
uv=(iux+juy+kuz)v=ivx+jvy+kvz
其中
u
≜
i
u
x
+
j
u
y
+
k
u
z
u\triangleq iu_x + ju_y + ku_z
u≜iux+juy+kuz是纯幺正的,v是范数,i, j, k是李代数
s
3
=
H
p
s^3 = H_p
s3=Hp的生成元。 重写我们上面的条件,