标签：Real Odometry phi Manifold align cdots ij Exp Delta

公式推导

根据等式（10）

\[R\ Exp(\phi)\ R^{T} = exp(R\phi^{\hat{}}R^{T}) = Exp(R\phi) \]

推导等式（11）

\[\begin{align*} Exp(\phi)R &= RR^{T}Exp(\phi)R \\ &= R(R^{T}Exp(\phi)R) \\ &= RExp(R^{T}\phi) \end{align*} \]

等式（35）部分推导

\[\prod_{k=i}^{j-1} \left[ Exp((\tilde{\omega}_k - b_i^g)\Delta t) Exp(-J_r^k \eta_k^{gd} \Delta t) \right] \\ \]

令\(Exp((\tilde{\omega}_k - b_i^g)\Delta t) = R_k\)，\(Exp(-J_r^k \eta_k^{gd} \Delta t) = Exp(\phi_k)\)

\[\begin{align*} \prod_{k=i}^{j-1} R_k Exp(\phi_k) &= R_iExp(\phi_i) R_{i+1}Exp(\phi_{i+1}) \cdots R_{j-2}Exp(\phi_{j-2}) R_{j-1}Exp(\phi_{j-1}) \\ &= R_iExp(\phi_i) R_{i+1}Exp(\phi_{i+1}) \cdots R_{j-2}(Exp(\phi_{j-2}) R_{j-1})Exp(\phi_{j-1}) \end{align*} \]

根据等式（11）括号中\((Exp(\phi_{j-2}) R_{j-1}) = R_{j-1} Exp(R^{T}_{j-1} \phi_{j-2})\)

\[\begin{align*} \prod_{k=i}^{j-1} R_k Exp(\phi_k) &= R_iExp(\phi_i) R_{i+1}Exp(\phi_{i+1}) \cdots R_{j-2}R_{j-1} Exp(R^{T}_{j-1} \phi_{j-2})Exp(\phi_{j-1}) \\ &= R_iExp(\phi_i) R_{i+1}Exp(\phi_{i+1}) \cdots R_{j-3}Exp(\phi_{j-3}) R_{j-2}R_{j-1} Exp(R^{T}_{j-1} \phi_{j-2})Exp(\phi_{j-1}) \\ &= R_iExp(\phi_i) R_{i+1}Exp(\phi_{i+1}) \cdots R_{j-3}R_{j-2}R_{j-1} Exp((R_{j-2}R_{j-1})^{T}\phi_{j-3}) Exp(R^{T}_{j-1} \phi_{j-2})Exp(\phi_{j-1}) \\ &\cdots \\ &= \Delta\tilde{R}_{ij} \prod_{k=i}^{j-1} Exp(- \Delta\tilde{R}_{k+1j} J_r^k \eta_k^{gd} \Delta t) \\ &= \Delta\tilde{R}_{ij} Exp(- \delta \phi_{ij}) \end{align*} \]

论文理解

等式（33）中，论文提到\(\Delta v_{ij}\)和\(\Delta p_{ij}\)与\(\Delta R_{ij}\)不同，它们不表示两时刻之间实际的速度和位置的物理变化。它们只是独立于时刻\(i\)和重力影响的一种预积分的表达形式，可以直接从IMU的观测中得到。

标签：Real,Odometry,phi,Manifold,align,cdots,ij,Exp,Delta
来源： https://www.cnblogs.com/zhanggengchen/p/15840836.html

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。