ethzasl-msf - Modular Sensor Fusion
Time delay compensated single and multi sensor fusion framework based on an EKF
|
Go to the source code of this file.
Functions | |
template<typename StateSequence_T , typename StateDefinition_T , class Derived , class DerivedQ > | |
void | calc_QCore (const double dt, const Eigen::Quaternion< double > &q, const Eigen::MatrixBase< Derived > &ew, const Eigen::MatrixBase< Derived > &ea, const Eigen::MatrixBase< Derived > &n_a, const Eigen::MatrixBase< Derived > &n_ba, const Eigen::MatrixBase< Derived > &n_w, const Eigen::MatrixBase< Derived > &n_bw, Eigen::MatrixBase< DerivedQ > &Qd) |
Calculate the observation covariance matrix for the core states. The user has the possibility to set the blocks of Q for user defined states. The EKF core calls the respective user defined function. |
void calc_QCore | ( | const double | dt, |
const Eigen::Quaternion< double > & | q, | ||
const Eigen::MatrixBase< Derived > & | ew, | ||
const Eigen::MatrixBase< Derived > & | ea, | ||
const Eigen::MatrixBase< Derived > & | n_a, | ||
const Eigen::MatrixBase< Derived > & | n_ba, | ||
const Eigen::MatrixBase< Derived > & | n_w, | ||
const Eigen::MatrixBase< Derived > & | n_bw, | ||
Eigen::MatrixBase< DerivedQ > & | Qd | ||
) |