@@ -123,33 +123,33 @@ As a reference, this is the way tangent spaces are defined in **manif**
123123| Rn | n | $\bf p$ | $\bf p$ | ${\bf p} = {\bf v}\cdot dt$ |
124124| SO(2) | 1 | $\bf R$ | $\theta$ | $\theta = \omega\cdot dt$ |
125125| SO(3) | 3 | $\bf R$ | $\boldsymbol\theta$ | $\boldsymbol\theta = \boldsymbol\omega\cdot dt$ |
126- | SE(2) | 3 | $\bf R $, $\bf p $ | $\boldsymbol\rho$, $\theta$ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\theta = \omega\cdot dt$ |
127- | SE(3) | 6 | $\bf R $, $\bf p $ | $\boldsymbol\rho$, $\boldsymbol\theta$ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\boldsymbol\theta = \boldsymbol\omega\cdot dt$ |
128- | SE_2(3) | 9 | $\bf R $, $\bf p $, $\bf v$ | $\boldsymbol\rho$, $\boldsymbol\nu $, $\boldsymbol\theta $ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\boldsymbol\nu = {\bf a}\cdot dt$<br />$\boldsymbol\theta = {\boldsymbol\omega}\cdot dt$ |
129- | SGal(3) | 10 | $\bf R $, $\bf p $, $\bf v$, $t$ | $\boldsymbol\rho$, $\boldsymbol\nu$, $\boldsymbol\theta$, $s$ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\boldsymbol\nu = {\bf a}\cdot dt$<br />$\boldsymbol\theta = {\boldsymbol\omega}\cdot dt$<br />$s = dt$ |
126+ | SE(2) | 3 | $\bf p $, $\bf R $ | $\boldsymbol\rho$, $\theta$ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\theta = \omega\cdot dt$ |
127+ | SE(3) | 6 | $\bf p $, $\bf R $ | $\boldsymbol\rho$, $\boldsymbol\theta$ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\boldsymbol\theta = \boldsymbol\omega\cdot dt$ |
128+ | SE_2(3) | 9 | $\bf p $, $\bf R $, $\bf v$ | $\boldsymbol\rho$, $\boldsymbol\theta $, $\boldsymbol\nu $ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\boldsymbol\nu = {\bf a}\cdot dt$<br />$\boldsymbol\theta = {\boldsymbol\omega}\cdot dt$ |
129+ | SGal(3) | 10 | $\bf p $, $\bf R $, $\bf v$, $t$ | $\boldsymbol\rho$, $\boldsymbol\nu$, $\boldsymbol\theta$, $s$ | $\boldsymbol\rho = {\bf v}\cdot dt$<br />$\boldsymbol\nu = {\bf a}\cdot dt$<br />$\boldsymbol\theta = {\boldsymbol\omega}\cdot dt$<br />$s = dt$ |
130130
131131As an example, in SE_2(3) the tangent vector ${\boldsymbol\tau}$ is defined by
132132
133133$$
134- {\boldsymbol\tau} =
135- \begin{bmatrix}
136- {\boldsymbol\rho} \\
137- {\boldsymbol\nu } \\
138- {\boldsymbol\theta}
134+ {\boldsymbol\tau} =
135+ \begin{bmatrix}
136+ {\boldsymbol\rho} \\
137+ {\boldsymbol\theta } \\
138+ {\boldsymbol\nu}
139139\end{bmatrix} \in \mathbb{R}^9
140140$$
141141
142- where $\boldsymbol\rho$, $\boldsymbol\nu $ and $\boldsymbol\theta $ are $\in \mathbb{R}^3$ and
143- typically correspond respectively to changes in position, velocity and orientation .
142+ where $\boldsymbol\rho$, $\boldsymbol\theta $ and $\boldsymbol\nu $ are $\in \mathbb{R}^3$ and
143+ typically correspond respectively to changes in position, orientation and velocity .
144144
145145A covariances matrix $\bf Q$ of an element of SE_2(3) can be block-partitioned as follows
146146
147147$$
148148{\bf Q} = \begin{bmatrix}
149- {\bf Q}_ {\boldsymbol\rho\boldsymbol\rho} & {\bf Q}_ {\boldsymbol\rho\boldsymbol\nu } & {\bf Q}_ {\boldsymbol\rho\boldsymbol\theta } \\
150- {\bf Q}_ {\boldsymbol\nu \boldsymbol\rho} & {\bf Q}_ {\boldsymbol\nu \boldsymbol\nu } & {\bf Q}_ {\boldsymbol\nu \boldsymbol\theta } \\
151- {\bf Q}_ {\boldsymbol\theta \boldsymbol\rho} & {\bf Q}_ {\boldsymbol\theta \boldsymbol\nu } & {\bf Q}_ {\boldsymbol\theta \boldsymbol\theta }
152- \end{bmatrix} \in \mathbb{R}^{9\times 9}
149+ {\bf Q}_ {\boldsymbol\rho\boldsymbol\rho} & {\bf Q}_ {\boldsymbol\rho\boldsymbol\theta } & {\bf Q}_ {\boldsymbol\rho\boldsymbol\nu } \\
150+ {\bf Q}_ {\boldsymbol\theta \boldsymbol\rho} & {\bf Q}_ {\boldsymbol\theta \boldsymbol\theta } & {\bf Q}_ {\boldsymbol\theta \boldsymbol\nu } \\
151+ {\bf Q}_ {\boldsymbol\nu \boldsymbol\rho} & {\bf Q}_ {\boldsymbol\nu \boldsymbol\theta } & {\bf Q}_ {\boldsymbol\nu \boldsymbol\nu }
152+ \end{bmatrix} \in \mathbb{R}^{9\times 9}
153153$$
154154
155155All blocks ${\bf Q}_ {\bf ij}$ are $3\times3$ and ${\bf Q}$ is $9\times9$.
0 commit comments