63 std::cerr <<
"MeasPdfPos::SampleFrom Method not applicable" << std::endl;
71 std::cerr <<
"MeasPdfPos::ExpectedValueGet Method not applicable" << std::endl;
80 std::cerr <<
"MeasPdfPos::CovarianceGet Method not applicable" << std::endl;
81 SymmetricMatrix Covar(DIM_MEASMODEL_POS);
89 tf::Vector3 cov_vec(sqrt(cov(1, 1)), sqrt(cov(2, 2)), sqrt(cov(3, 3)));
virtual tf::Vector3 ExpectedValueGet() const
void sigmaSet(const tf::Vector3 &sigma)
Class representing state with pos and vel.
virtual Probability ProbabilityGet(const tf::Vector3 &input) const
GaussianVector meas_noise_
virtual BFL::Probability ProbabilityGet(const tf::Vector3 &input) const
virtual ~MeasPdfPos()
Destructor.
MeasPdfPos(const tf::Vector3 &sigma)
Constructor.
TFSIMD_FORCE_INLINE Vector3()
virtual MatrixWrapper::SymmetricMatrix CovarianceGet() const
static const unsigned int DIM_MEASMODEL_POS
const StatePosVel & ConditionalArgumentGet(unsigned int n_argument) const
void CovarianceSet(const MatrixWrapper::SymmetricMatrix &cov)
virtual bool SampleFrom(BFL::Sample< tf::Vector3 > &one_sample, int method, void *args) const
static const unsigned int NUM_MEASMODEL_POS_COND_ARGS