![]() |
MSCEqF 1.0
Multi State Constraint Equivariant Filter for visual inertial navigation
|
Public Member Functions | |
| MSCEqF (const std::string ¶ms_filepath) | |
| MSCEqF Constructor. | |
| void | processMeasurement (const Imu &meas) |
| Process IMU measurement. | |
| void | processMeasurement (Camera &meas) |
| Process camera measurement. | |
| void | processMeasurement (TriangulatedFeatures &meas) |
| Process triangulated features measurement. | |
| const MSCEqFOptions & | options () const |
| Get a constant reference to the MSCEqF options. | |
| const StateOptions & | stateOptions () const |
| Get a constant reference to the MSCEqF state options. | |
| const MatrixX & | covariance () const |
| Get a constant reference to the covariance matrix of the MSCEqF state. | |
| const MatrixX | coreCovariance () const |
| Get the covariance of the navigation states (D, delta). | |
| const SystemState & | stateEstimate () const |
| Get a constant reference to the estimated state. | |
| const SystemState & | stateOrigin () const |
| Get a constant reference to the origin state. | |
| void | setGivenOrigin (const SE23 &T0, const Vector6 &b0, const fp ×tamp) |
| Set origin xi0 with given state programatically. | |
| const cv::Mat3b | imageWithTracks (const Camera &cam) const |
| Get the processed image with overlayed tracks. | |
| void | visualizeImageWithTracks (const Camera &cam) const |
| Visualize the processed image with overlayed tracks. | |
| const bool & | isInit () const |
| Check if the filter is initialized. | |
| const bool & | zvuPerformed () const |
| Check if a zero velocity update has been performed. | |
| msceqf::MSCEqF::MSCEqF | ( | const std::string & | params_filepath | ) |
MSCEqF Constructor.
| params_filepath | filepath of the parameter file to be parsed |
| const MatrixX msceqf::MSCEqF::coreCovariance | ( | ) | const |
Get the covariance of the navigation states (D, delta).
| const MatrixX & msceqf::MSCEqF::covariance | ( | ) | const |
Get a constant reference to the covariance matrix of the MSCEqF state.
| const cv::Mat3b msceqf::MSCEqF::imageWithTracks | ( | const Camera & | cam | ) | const |
Get the processed image with overlayed tracks.
|
nodiscard |
Check if the filter is initialized.
| const MSCEqFOptions & msceqf::MSCEqF::options | ( | ) | const |
Get a constant reference to the MSCEqF options.
|
inline |
Process camera measurement.
| meas | Camera measurement |
|
inline |
Process IMU measurement.
| meas | IMU measurement |
|
inline |
Process triangulated features measurement.
| meas | Triangulated features measurement |
| void msceqf::MSCEqF::setGivenOrigin | ( | const SE23 & | T0, |
| const Vector6 & | b0, | ||
| const fp & | timestamp ) |
Set origin xi0 with given state programatically.
| T0 | Origin extended pose |
| b0 | Origin bias |
| timestamp | initial timestamp |
| const SystemState & msceqf::MSCEqF::stateEstimate | ( | ) | const |
Get a constant reference to the estimated state.
| const StateOptions & msceqf::MSCEqF::stateOptions | ( | ) | const |
Get a constant reference to the MSCEqF state options.
| const SystemState & msceqf::MSCEqF::stateOrigin | ( | ) | const |
Get a constant reference to the origin state.
| void msceqf::MSCEqF::visualizeImageWithTracks | ( | const Camera & | cam | ) | const |
Visualize the processed image with overlayed tracks.
| cam | Camera measurement |
|
nodiscard |
Check if a zero velocity update has been performed.