标签：wedge phi 李群 cos SLAM exp theta 代数 sin
在学习 十四讲时，李群和李代数相互转换公式为
e
x
p
(
ϕ
∧
)
=
e
x
p
(
θ
a
∧
)
=
c
o
s
θ
I
+
(
1
−
c
o
s
θ
)
a
a
T
+
s
i
n
θ
a
∧
exp(\phi^{\wedge})=exp(\theta a^{\wedge})=cos\theta I+(1-cos\theta)aa^{T}+sin\theta a^{\wedge}
exp(ϕ∧)=exp(θa∧)=cosθI+(1−cosθ)aaT+sinθa∧
其证明过程可以参考四十讲
而在选在IMU 预积分中,李群和李代数相互转换公式为
e
x
p
(
ϕ
∧
)
=
I
+
s
i
n
(
∣
∣
ϕ
∣
∣
)
∣
∣
ϕ
∣
∣
ϕ
∧
+
1
−
c
o
s
(
∣
∣
ϕ
∣
∣
)
∣
∣
ϕ
∣
∣
2
(
ϕ
∧
)
2
exp(\phi^{\wedge})= I+\frac{sin(||\phi ||)}{||\phi||}\phi^{\wedge}+\frac{1-cos(||\phi ||)}{||\phi||^{2}}(\phi^{\wedge})^{2}
exp(ϕ∧)=I+∣∣ϕ∣∣sin(∣∣ϕ∣∣)ϕ∧+∣∣ϕ∣∣21−cos(∣∣ϕ∣∣)(ϕ∧)2
这是两种等价的表示方式
下边我们简单证明下:
ϕ
=
θ
a
⃗
a
∧
a
∧
=
a
a
T
−
I
\phi = \theta \vec{a} \\ a^{\wedge}a^{\wedge} = aa^{T}-I\\
ϕ=θa
a∧a∧=aaT−I
则有
∣
∣
ϕ
∣
∣
=
θ
ϕ
∧
=
θ
a
∧
=
∣
∣
ϕ
∣
∣
a
∧
a
∧
=
ϕ
∧
∣
∣
ϕ
∣
∣
(
ϕ
∧
)
2
=
θ
2
(
a
a
T
−
I
)
=
∣
∣
ϕ
∣
∣
2
(
a
a
T
−
I
)
a
a
T
=
(
ϕ
∧
)
2
∣
∣
ϕ
∣
∣
2
+
I
||\phi||=\theta\\ {\phi}^{\wedge} =\theta a^{\wedge}=||\phi||a^{\wedge}\\ a^{\wedge}=\frac{{\phi}^{\wedge} }{||\phi||}\\ ({\phi}^{\wedge})^{2} = \theta^{2}(aa^{T}-I)=||\phi||^{2}(aa^{T}-I)\\ aa^{T}=\frac{({\phi}^{\wedge})^{2}}{||\phi||^{2}}+I
∣∣ϕ∣∣=θϕ∧=θa∧=∣∣ϕ∣∣a∧a∧=∣∣ϕ∣∣ϕ∧(ϕ∧)2=θ2(aaT−I)=∣∣ϕ∣∣2(aaT−I)aaT=∣∣ϕ∣∣2(ϕ∧)2+I
带入
e
x
p
(
ϕ
∧
)
=
e
x
p
(
θ
a
∧
)
=
c
o
s
θ
I
+
(
1
−
c
o
s
θ
)
a
a
T
+
s
i
n
θ
a
∧
exp(\phi^{\wedge})=exp(\theta a^{\wedge})=cos\theta I+(1-cos\theta)aa^{T}+sin\theta a^{\wedge}
exp(ϕ∧)=exp(θa∧)=cosθI+(1−cosθ)aaT+sinθa∧
则有
e
x
p
(
ϕ
∧
)
=
c
o
s
∣
∣
ϕ
∣
∣
I
+
(
1
−
c
o
s
∣
∣
ϕ
∣
∣
)
∗
(
(
ϕ
∧
)
2
∣
∣
ϕ
∣
∣
2
+
I
)
+
s
i
n
∣
∣
ϕ
∣
∣
∗
ϕ
∧
∣
∣
ϕ
∣
∣
=
I
+
s
i
n
(
∣
∣
ϕ
∣
∣
)
∣
∣
ϕ
∣
∣
ϕ
∧
+
1
−
c
o
s
(
∣
∣
ϕ
∣
∣
)
∣
∣
ϕ
∣
∣
2
(
ϕ
∧
)
2
exp(\phi^{\wedge})=cos||\phi|| I+(1-cos||\phi||)*(\frac{({\phi}^{\wedge})^{2}}{||\phi||^{2}}+I)+sin||\phi|| *\frac{{\phi}^{\wedge} }{||\phi||}\\ =I+\frac{sin(||\phi ||)}{||\phi||}\phi^{\wedge}+\frac{1-cos(||\phi ||)}{||\phi||^{2}}(\phi^{\wedge})^{2}
exp(ϕ∧)=cos∣∣ϕ∣∣I+(1−cos∣∣ϕ∣∣)∗(∣∣ϕ∣∣2(ϕ∧)2+I)+sin∣∣ϕ∣∣∗∣∣ϕ∣∣ϕ∧=I+∣∣ϕ∣∣sin(∣∣ϕ∣∣)ϕ∧+∣∣ϕ∣∣21−cos(∣∣ϕ∣∣)(ϕ∧)2
标签：wedge,phi,李群,cos,SLAM,exp,theta,代数,sin 来源： https://blog.csdn.net/m0_54238665/article/details/122805107
本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享； 2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关； 3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关； 4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除； 5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。