50 MeasPdfPos::MeasPdfPos(
const Vector3& sigma)
52 meas_noise_(
Vector3(0, 0, 0), sigma)
73 cerr <<
"MeasPdfPos::SampleFrom Method not applicable" << endl;
84 cerr <<
"MeasPdfPos::ExpectedValueGet Method not applicable" << endl;
96 cerr <<
"MeasPdfPos::CovarianceGet Method not applicable" << endl;
106 tf::Vector3 cov_vec(sqrt(cov(1, 1)), sqrt(cov(2, 2)), sqrt(cov(3, 3)));
void sigmaSet(const tf::Vector3 &sigma)
Class representing state with pos and vel.
virtual Probability ProbabilityGet(const tf::Vector3 &input) const
GaussianVector meas_noise_
void CovarianceSet(const MatrixWrapper::SymmetricMatrix &cov)
virtual MatrixWrapper::SymmetricMatrix CovarianceGet() const
virtual tf::Vector3 ExpectedValueGet() const
static const unsigned int NUM_MEASMODEL_POS_COND_ARGS
static const unsigned int DIM_MEASMODEL_POS
virtual ~MeasPdfPos()
Destructor.
virtual BFL::Probability ProbabilityGet(const tf::Vector3 &input) const
virtual bool SampleFrom(BFL::Sample< tf::Vector3 > &one_sample, int method, void *args) const