当前位置：网站首页>Application du Groupe Li dans gtsam

Application du Groupe Li dans gtsam

2022-07-06 06:01:00 【Zhanjiang】

1. AdjointMapDéfinition

Pourquoi dans la matrice Li Qun,Les deux définitions ci - dessus peuvent être mélangées？La preuve est la suivante:

$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. Li Qun AdjointMap

Comment la formule ci - dessus tire - t - elle les conclusions suivantes

AdjointMap Est la cartographie de la Matrice antisymétrique à la Matrice antisymétrique

Ordre

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

Alors la formule ci - dessus peut être écrite comme suit

$\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}$

Et j'ai poussé la formule suivante

3. Local Coordinates

Il y a une telle formule

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

La preuve est la suivante:

$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$

Preuve

Par

Oui.

$\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)$