#include <detector_filter.h>
Public Member Functions | |
DetectorFilter () | |
bool | getPose (geometry_msgs::PoseWithCovarianceStamped &pose) |
~DetectorFilter () | |
Private Member Functions | |
void | composeTransform (const MatrixWrapper::ColumnVector &vector, geometry_msgs::PoseWithCovarianceStamped &pose) |
void | decomposeTransform (const geometry_msgs::PoseWithCovarianceStamped &pose, MatrixWrapper::ColumnVector &vector) |
void | initialize (const geometry_msgs::PoseWithCovarianceStamped &pose) |
void | poseCallback (const geometry_msgs::PoseWithCovarianceStampedConstPtr &pose) |
bool | resetState (std_srvs::Empty::Request &req, std_srvs::Empty::Response &res) |
Private Attributes | |
BFL::ExtendedKalmanFilter * | filter_ |
ros::Time | filter_time_ |
std::string | fixed_frame_ |
bool | initialized_ |
BFL::LinearAnalyticMeasurementModelGaussianUncertainty * | meas_model_ |
BFL::LinearAnalyticConditionalGaussian * | meas_pdf_ |
ros::Subscriber | pose_sub_ |
BFL::Gaussian * | prior_ |
ros::ServiceServer | reset_srv_ |
BFL::LinearAnalyticSystemModelGaussianUncertainty * | sys_model_ |
BFL::LinearAnalyticConditionalGaussian * | sys_pdf_ |
tf::TransformListener | tf_ |
Definition at line 54 of file detector_filter.h.
Definition at line 50 of file detector_filter.cpp.
Definition at line 88 of file detector_filter.cpp.
void detector::DetectorFilter::composeTransform | ( | const MatrixWrapper::ColumnVector & | vector, |
geometry_msgs::PoseWithCovarianceStamped & | pose | ||
) | [private] |
Definition at line 194 of file detector_filter.cpp.
void detector::DetectorFilter::decomposeTransform | ( | const geometry_msgs::PoseWithCovarianceStamped & | pose, |
MatrixWrapper::ColumnVector & | vector | ||
) | [private] |
Definition at line 177 of file detector_filter.cpp.
bool detector::DetectorFilter::getPose | ( | geometry_msgs::PoseWithCovarianceStamped & | pose | ) |
Definition at line 210 of file detector_filter.cpp.
void detector::DetectorFilter::initialize | ( | const geometry_msgs::PoseWithCovarianceStamped & | pose | ) | [private] |
Definition at line 156 of file detector_filter.cpp.
void detector::DetectorFilter::poseCallback | ( | const geometry_msgs::PoseWithCovarianceStampedConstPtr & | pose | ) | [private] |
Definition at line 100 of file detector_filter.cpp.
bool detector::DetectorFilter::resetState | ( | std_srvs::Empty::Request & | req, |
std_srvs::Empty::Response & | res | ||
) | [private] |
Definition at line 232 of file detector_filter.cpp.
BFL::ExtendedKalmanFilter* detector::DetectorFilter::filter_ [private] |
Definition at line 84 of file detector_filter.h.
Definition at line 85 of file detector_filter.h.
std::string detector::DetectorFilter::fixed_frame_ [private] |
Definition at line 74 of file detector_filter.h.
bool detector::DetectorFilter::initialized_ [private] |
Definition at line 75 of file detector_filter.h.
BFL::LinearAnalyticMeasurementModelGaussianUncertainty* detector::DetectorFilter::meas_model_ [private] |
Definition at line 82 of file detector_filter.h.
BFL::LinearAnalyticConditionalGaussian* detector::DetectorFilter::meas_pdf_ [private] |
Definition at line 81 of file detector_filter.h.
Definition at line 72 of file detector_filter.h.
BFL::Gaussian* detector::DetectorFilter::prior_ [private] |
Definition at line 83 of file detector_filter.h.
Definition at line 73 of file detector_filter.h.
BFL::LinearAnalyticSystemModelGaussianUncertainty* detector::DetectorFilter::sys_model_ [private] |
Definition at line 80 of file detector_filter.h.
BFL::LinearAnalyticConditionalGaussian* detector::DetectorFilter::sys_pdf_ [private] |
Definition at line 79 of file detector_filter.h.
Definition at line 76 of file detector_filter.h.