mars_lib  0.1.0.3dc76ee85e09
Modular and Robust Sensor-Fusion
Public Member Functions | Public Attributes | Private Member Functions | List of all members
mars::Ekf Class Reference

#include </home/runner/work/mars_lib/mars_lib/source/mars/include/mars/ekf.h>

+ Collaboration diagram for mars::Ekf:

Public Member Functions

EIGEN_MAKE_ALIGNED_OPERATOR_NEW Ekf (const Eigen::Ref< const Eigen::MatrixXd > &H, const Eigen::Ref< const Eigen::MatrixXd > &R, const Eigen::Ref< const Eigen::MatrixXd > &res, const Eigen::Ref< const Eigen::MatrixXd > &P)
 Ekf Essential EFK update component. More...
 
Eigen::MatrixXd CalculateCorrection ()
 Kalman gain. More...
 
Eigen::MatrixXd CalculateCorrection (Chi2 *chi2)
 CalculateCorrection Calculating the state correction with a post Chi2 test. More...
 
Eigen::MatrixXd CalculateCovUpdate ()
 CalculateCovUpdate Updating the state covariance after the state update. More...
 

Public Attributes

Eigen::MatrixXd H_
 
Eigen::MatrixXd R_
 Jacobian. More...
 
Eigen::MatrixXd res_
 Measurement noise. More...
 
Eigen::MatrixXd P_
 Residual. More...
 
Eigen::MatrixXd S_
 State covariance. More...
 
Eigen::MatrixXd K_
 Innovation / variance of the residual. More...
 

Private Member Functions

Eigen::MatrixXd CalculateStateCorrection ()
 CalculateStateCorrection Calculation of EKF components, correction, innovation etc. More...
 

Constructor & Destructor Documentation

◆ Ekf()

EIGEN_MAKE_ALIGNED_OPERATOR_NEW mars::Ekf::Ekf ( const Eigen::Ref< const Eigen::MatrixXd > &  H,
const Eigen::Ref< const Eigen::MatrixXd > &  R,
const Eigen::Ref< const Eigen::MatrixXd > &  res,
const Eigen::Ref< const Eigen::MatrixXd > &  P 
)
inline

Ekf Essential EFK update component.

Parameters
HJacobian
RMeasurement noise
resResidual
PState covariance
105  {
106  this->H_ = H;
107  this->R_ = R;
108  this->res_ = res;
109  this->P_ = P;
110  }
Eigen::MatrixXd H_
Definition: ekf.h:112
Eigen::MatrixXd res_
Measurement noise.
Definition: ekf.h:114
Eigen::MatrixXd P_
Residual.
Definition: ekf.h:115
Eigen::MatrixXd R_
Jacobian.
Definition: ekf.h:113

Member Function Documentation

◆ CalculateCorrection() [1/2]

Eigen::MatrixXd mars::Ekf::CalculateCorrection ( )

Kalman gain.

CalculateCorrection Calculating the state correction without a post Chi2 test

Returns
+ Here is the caller graph for this function:

◆ CalculateCorrection() [2/2]

Eigen::MatrixXd mars::Ekf::CalculateCorrection ( Chi2 chi2)

CalculateCorrection Calculating the state correction with a post Chi2 test.

Parameters
chi2'Chi2' class based on the sensor measurement
Returns

◆ CalculateCovUpdate()

Eigen::MatrixXd mars::Ekf::CalculateCovUpdate ( )

CalculateCovUpdate Updating the state covariance after the state update.

Returns
Updated state covariance matrix
+ Here is the caller graph for this function:

◆ CalculateStateCorrection()

Eigen::MatrixXd mars::Ekf::CalculateStateCorrection ( )
private

CalculateStateCorrection Calculation of EKF components, correction, innovation etc.

Returns
State correction vector

Member Data Documentation

◆ H_

Eigen::MatrixXd mars::Ekf::H_

◆ R_

Eigen::MatrixXd mars::Ekf::R_

Jacobian.

◆ res_

Eigen::MatrixXd mars::Ekf::res_

Measurement noise.

◆ P_

Eigen::MatrixXd mars::Ekf::P_

Residual.

◆ S_

Eigen::MatrixXd mars::Ekf::S_

State covariance.

◆ K_

Eigen::MatrixXd mars::Ekf::K_

Innovation / variance of the residual.


The documentation for this class was generated from the following file: