当前位置：网站首页>GTSAM中李群的运用

GTSAM中李群的运用

2022-07-06 05:58:00 【瞻邈】

1. AdjointMap定义

为何在矩阵李群中，上述两种定义可以混用呢？证明如下

$Ad_T \hat{x} = T \hat{x}T^{-1} \Rightarrow \\ exp(Ad_T \hat{x}) = \sum_{n = 0}^{\infty} \frac{1}{n!} \left( Ad_T\hat{x} \right)^n = \sum_{n = 0}^{\infty} \frac{1}{n!} \left( T \hat{x}T^{-1} \right)^n \\ = \sum_{n = 0}^{\infty} \frac{1}{n!} T \hat{x}^nT^{-1} = T \sum_{n = 0}^{\infty} \frac{\hat{x}^n}{n!} T^{-1} = T e^{\hat{x}} T^{-1} = Ad_T e^{\hat{x}}$

2. 李群的AdjointMap

上面的公式如何得出下面的结论

AdjointMap是反对称矩阵到反对称矩阵的映射

令

$\xi' = \begin{bmatrix} \omega' \\ v' \end{bmatrix}$

则上面的公式可以写成下式

$\begin{bmatrix} [\omega']_{\times} & v' \\ 0 & 0 \end{bmatrix} = \begin{bmatrix} [R\omega]_{\times} & t \times R\omega + Rv \\ 0 & 0 \end{bmatrix} \Rightarrow \begin{cases} \omega' = R \omega \\ v' = t \times R\omega + Rv \end{cases}$

继而推得下面的式子

3. Local Coordinates

有这样一个公式

$a e^{-\hat{x}}a^{-1} = -a e^{\hat{x}}a^{-1}$

证明如下

$a e^{-\hat{x}}a^{-1} = exp(-a \hat x a^{-1}) \\ = \sum_{n=0}^{\infty} \frac{1}{n!} (-a \hat x a^{-1})^n \\ = \sum_{n=0}^{\infty} \frac{1}{n!} (-a \hat x^n a^{-1}) \\ = -a \sum_{n=0}^{\infty} \frac{\hat x^n}{n!} a \\ = -a e^{\hat{x}}a^{-1}$

4. ImuFactor

$\frac{\partial R_k}{\partial \theta_k} = H(\theta_k) = \sum_{k=0}^{\infty} \frac{(-1)^k}{(k+1)!}[\theta]_{\times}^k$

证明

由

得

$\frac{\partial R_k}{\partial \theta_k} \\ = \lim_{\delta \rightarrow0} \frac{ exp([\theta + \delta]_{\times}) \ominus exp([\theta]_{\times}) }{\delta} \\ = \lim_{\delta \rightarrow0} \frac{Log \left( exp([-\theta]_{\times}) exp([\theta + \delta]_{\times}) \right) }{\delta} \\ = \lim_{\delta \rightarrow0} \frac{Log \left( exp([-\theta]_{\times}) exp([\theta]_{\times}) exp([H(\theta)\delta]_{\times}) \right) }{\delta} \\ = \lim_{\delta \rightarrow0} \frac{Log \left( exp([H(\theta)\delta]_{\times}) \right) }{\delta} \\ = H(\theta)$