38 #include <bfl/wrappers/rng/rng.h> 49 gauss_pos_(mu.pos_, sigma.pos_),
50 gauss_vel_(mu.vel_, sigma.vel_)
77 list_samples.resize(num_samples);
78 std::vector<Sample<StatePosVel> >::iterator sample_it = list_samples.begin();
79 for (sample_it = list_samples.begin(); sample_it != list_samples.end(); sample_it++)
106 SymmetricMatrix sigma(6);
108 for (
unsigned int i = 0; i < 3; i++)
virtual MatrixWrapper::SymmetricMatrix CovarianceGet() const
double rnorm(const double &mu, const double &sigma)
Class representing state with pos and vel.
virtual Probability ProbabilityGet(const tf::Vector3 &input) const
GaussianPosVel(const StatePosVel &mu, const StatePosVel &sigma)
Constructor.
virtual GaussianPosVel * Clone() const
clone function
void ValueSet(const T &value)
virtual StatePosVel ExpectedValueGet() const
virtual Probability ProbabilityGet(const StatePosVel &input) const
virtual ~GaussianPosVel()
Destructor.
friend std::ostream & operator<<(std::ostream &os, const GaussianPosVel &g)
output stream for GaussianPosVel
Class representing gaussian pos_vel.
GaussianVector gauss_vel_
bool SampleFrom(vector< Sample< StatePosVel > > &list_samples, const int num_samples, int method=DEFAULT, void *args=NULL) const
GaussianVector gauss_pos_