例四和例五:The exponential map of SO(3)+

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)=R0exp([ω]×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θωtR3 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([θ]×)=kk!θ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=uutI,  [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θ24!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(1cosθ)
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)=R0exp([ω]×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θωtR3 为角度轴形式的积分旋转,角度 θ 和单位轴 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([θ]×)=kk!θ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=uutI,  [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θ24!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(1cosθ)
这个表达式就是众所周知的罗德里格斯旋转公式。 只需执行以下操作即可将其用作大写指数 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 qq=1 yields
q ∗ q ˙ = − ( q ∗ q ˙ ) ∗ . q^*\dot q = −(q^*\dot q)^∗. qq˙=(qq˙).
This reveals that q ∗ q ˙ q^*\dot q qq˙ 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 uiux+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=q0exp(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:R3s3;θθ=2φVee:s3R3;φφ=θ/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 qq=1 的时间导数要求
q ∗ q ˙ = − ( q ∗ q ˙ ) ∗ . q^*\dot q = −(q^*\dot q)^∗. qq˙=(qq˙).
这表明 q ∗ q ˙ q^*\dot q qq˙ 是一个纯四元数(它的实部为零)。 纯四元数 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 uiux+juy+kuz是纯幺正的,v是范数,i, j, k是李代数 s 3 = H p s^3 = H_p s3=Hp的生成元。 重写我们上面的条件,

  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值