![]() |
MSCEqF 1.0
Multi State Constraint Equivariant Filter for visual inertial navigation
|
Static Public Member Functions | |
| static const SystemState | phi (const MSCEqFState &X, const SystemState &xi) |
| Implement the right group action phi of the symmetry group, acting on the homogenous space (phi(X, xi)). | |
| static const SystemState::SystemStateAlgebraMap | lift (const SystemState &xi, const Imu &u) |
| Implement the lift function. Lift the actual dynamics onto the symmetry group. | |
| static const MatrixX | curvatureCorrection (const MSCEqFState &X, const VectorX &inn) |
| Return the Gamma matrix for the reset / curvature correction. | |
Static Public Attributes | |
| static const Matrix5 | D |
| The D matrix. | |
|
staticnodiscard |
Return the Gamma matrix for the reset / curvature correction.
| X | MSCEqF state (symmetry group element) |
| inn | Innovatiation vector |
|
staticnodiscard |
|
staticnodiscard |
Implement the right group action phi of the symmetry group, acting on the homogenous space (phi(X, xi)).
| X | MSCEqF state (symmetry group element) |
| xi | System state (homogenous space element) |