virtual double getQuality() const
return measure for tracker quality: 0=bad 1=good
virtual double getLifetime() const
return the lifetime of the tracker
virtual void getEstimate(BFL::StatePosVel &est) const
get filter posterior
virtual ~TrackerParticle()
destructor
virtual void initialize(const BFL::StatePosVel &mu, const BFL::StatePosVel &sigma, const double time)
initialize tracker
BFL::BootstrapFilter< BFL::StatePosVel, tf::Vector3 > * filter_
TrackerParticle(const std::string &name, unsigned int num_particles, const BFL::StatePosVel &sysnoise)
constructor
virtual bool updatePrediction(const double time)
update tracker
virtual bool updateCorrection(const tf::Vector3 &meas, const MatrixWrapper::SymmetricMatrix &cov)
bool tracker_initialized_
unsigned int num_particles_
MatrixWrapper::Matrix getHistogramVel(const tf::Vector3 &min, const tf::Vector3 &max, const tf::Vector3 &step) const
void getParticleCloud(const tf::Vector3 &step, double threshold, sensor_msgs::PointCloud &cloud) const
MatrixWrapper::Matrix getHistogramPos(const tf::Vector3 &min, const tf::Vector3 &max, const tf::Vector3 &step) const
Get histogram from certain area.
BFL::MeasModelPos meas_model_
BFL::SysModelPosVel sys_model_
virtual double getTime() const
return the time of the tracker
virtual bool isInitialized() const
return if tracker was initialized