Two Group Frame

概念

常见的导航问题可带入此框架,便于应用不变卡尔曼滤波算法

群结构

状态量的定义

$$ \mathbf{\chi} = \begin{pmatrix} R \\ x \\ \Chi \end{pmatrix} = (R,x,\Chi) $$ 其中 $ R \in G, x \in V, \Chi \in B $

$$ \mathbf{\chi}^{-1} = (R^{-1},-R^{-1}x,-R\Chi) $$

运算法则

$$ \begin{pmatrix} R_1 \\ x_1 \\ \Chi_1 \end{pmatrix} \bullet \begin{pmatrix} R_2 \\ x_2 \\ \Chi_2 \end{pmatrix} = \begin{pmatrix} R_1 R_2 \\ x_1 + R_1*x_2 \\ \Chi_2 + R_2^{-1} * \Chi_1 \end{pmatrix} $$

Licensed under CC BY-NC-SA 4.0