#include <GraftUKFAbsolute.h>
Public Member Functions | |
MatrixXd | f (MatrixXd x, double dt) |
graft::GraftStatePtr | getMessageFromState () |
graft::GraftStatePtr | getMessageFromState (Matrix< double, SIZE, 1 > &state, Matrix< double, SIZE, SIZE > &covariance) |
GraftUKFAbsolute () | |
std::vector< MatrixXd > | predict_sigma_points (std::vector< MatrixXd > &sigma_points, double dt) |
double | predictAndUpdate () |
void | setAlpha (const double alpha) |
void | setBeta (const double beta) |
void | setInitialCovariance (std::vector< double > &P) |
void | setKappa (const double kappa) |
void | setProcessNoise (std::vector< double > &Q) |
void | setTopics (std::vector< boost::shared_ptr< GraftSensor > > &topics) |
~GraftUKFAbsolute () | |
Private Attributes | |
double | alpha_ |
double | beta_ |
Matrix< double, SIZE, 1 > | graft_control_ |
Matrix< double, SIZE, SIZE > | graft_covariance_ |
Matrix< double, SIZE, 1 > | graft_state_ |
double | kappa_ |
ros::Time | last_imu_time_ |
ros::Time | last_update_time_ |
Matrix< double, SIZE, SIZE > | Q_ |
std::vector< boost::shared_ptr < GraftSensor > > | topics_ |
Definition at line 51 of file GraftUKFAbsolute.h.
Definition at line 37 of file GraftUKFAbsolute.cpp.
Definition at line 45 of file GraftUKFAbsolute.cpp.
MatrixXd GraftUKFAbsolute::f | ( | MatrixXd | x, |
double | dt | ||
) |
Definition at line 170 of file GraftUKFAbsolute.cpp.
graft::GraftStatePtr GraftUKFAbsolute::getMessageFromState | ( | ) |
Definition at line 214 of file GraftUKFAbsolute.cpp.
graft::GraftStatePtr GraftUKFAbsolute::getMessageFromState | ( | Matrix< double, SIZE, 1 > & | state, |
Matrix< double, SIZE, SIZE > & | covariance | ||
) |
Definition at line 218 of file GraftUKFAbsolute.cpp.
std::vector< MatrixXd > GraftUKFAbsolute::predict_sigma_points | ( | std::vector< MatrixXd > & | sigma_points, |
double | dt | ||
) |
Definition at line 206 of file GraftUKFAbsolute.cpp.
double GraftUKFAbsolute::predictAndUpdate | ( | ) |
Definition at line 370 of file GraftUKFAbsolute.cpp.
void GraftUKFAbsolute::setAlpha | ( | const double | alpha | ) |
Definition at line 451 of file GraftUKFAbsolute.cpp.
void GraftUKFAbsolute::setBeta | ( | const double | beta | ) |
Definition at line 459 of file GraftUKFAbsolute.cpp.
void GraftUKFAbsolute::setInitialCovariance | ( | std::vector< double > & | P | ) |
Definition at line 415 of file GraftUKFAbsolute.cpp.
void GraftUKFAbsolute::setKappa | ( | const double | kappa | ) |
Definition at line 455 of file GraftUKFAbsolute.cpp.
void GraftUKFAbsolute::setProcessNoise | ( | std::vector< double > & | Q | ) |
Definition at line 433 of file GraftUKFAbsolute.cpp.
void GraftUKFAbsolute::setTopics | ( | std::vector< boost::shared_ptr< GraftSensor > > & | topics | ) |
Definition at line 411 of file GraftUKFAbsolute.cpp.
double GraftUKFAbsolute::alpha_ [private] |
Definition at line 89 of file GraftUKFAbsolute.h.
double GraftUKFAbsolute::beta_ [private] |
Definition at line 90 of file GraftUKFAbsolute.h.
Matrix<double, SIZE, 1> GraftUKFAbsolute::graft_control_ [private] |
Definition at line 81 of file GraftUKFAbsolute.h.
Matrix<double, SIZE, SIZE> GraftUKFAbsolute::graft_covariance_ [private] |
Definition at line 82 of file GraftUKFAbsolute.h.
Matrix<double, SIZE, 1> GraftUKFAbsolute::graft_state_ [private] |
Definition at line 80 of file GraftUKFAbsolute.h.
double GraftUKFAbsolute::kappa_ [private] |
Definition at line 91 of file GraftUKFAbsolute.h.
ros::Time GraftUKFAbsolute::last_imu_time_ [private] |
Definition at line 87 of file GraftUKFAbsolute.h.
ros::Time GraftUKFAbsolute::last_update_time_ [private] |
Definition at line 86 of file GraftUKFAbsolute.h.
Matrix<double, SIZE, SIZE> GraftUKFAbsolute::Q_ [private] |
Definition at line 84 of file GraftUKFAbsolute.h.
std::vector<boost::shared_ptr<GraftSensor> > GraftUKFAbsolute::topics_ [private] |
Definition at line 93 of file GraftUKFAbsolute.h.