Jafar
|
Basic particle filter. More...
Basic particle filter.
Definition at line 18 of file particleFilter.hpp.
#include <particleFilter.hpp>
Public Types | |
typedef std::vector < jblas::vec >::iterator | STATE_IT |
typedef std::vector < jblas::vec >::const_iterator | STATE_CONST_IT |
Public Member Functions | |
ParticleFilter (std::size_t nbParticles_, std::size_t sizeState_, const jblas::vec &stateMin_, const jblas::vec &stateMax_) | |
Create a particle filter. | |
std::size_t | sizeState () const |
std::size_t | getNbParticles () const |
double | getWeight (std::size_t index_) const |
const jblas::vec & | getState (std::size_t index_) const |
void | predict (LinearPredictModel &m_) |
void | update (jafar::filter::JacobianObserveModel &m_, double z_) |
This function computes the observation step (innovation is given). | |
const jblas::vec & | getStateMean () |
Resample the particles. | |
const jblas::sym_mat & | getStateCov () |
Protected Member Functions | |
void | computeMeanAndCov () |
Protected Attributes | |
std::size_t | nbParticles |
std::size_t | _sizeState |
jblas::vec | weight |
std::vector< jblas::vec > | states |
jblas::vec | stateMean |
jblas::sym_mat | stateCov |
bool | meanAndCovUpToDate |
jafar::jmath::MultiDimNormalDistribution | predictNoise |
jafar::filter::ParticleFilter::ParticleFilter | ( | std::size_t | nbParticles_, |
std::size_t | sizeState_, | ||
const jblas::vec & | stateMin_, | ||
const jblas::vec & | stateMax_ | ||
) |
Create a particle filter.
nbParticles_ | the initial number of particles |
sizeState_ | the size of the estimated state Create a particle filter with a set of identical particles. |
nbParticles_ | The initial number of particles |
initState_ | The initial state of the particles Create a particule filter with uniformly chosen particles. |
nbParticles_ | The initial number of particles |
sizeState_ | the size of the estimated state |
stateMin_ | The lower state |
stateMax_ | The upper state |
Resample the particles.
The number of particles remains the same. Resample a new nember of particles.
nbParticles_ | The new nember of particles |
void jafar::filter::ParticleFilter::update | ( | jafar::filter::JacobianObserveModel & | m_, |
double | z_ | ||
) |
This function computes the observation step (innovation is given).
m_ | observation model |
z_ | observation |
R_ | measure noise covariance |
Generated on Wed Oct 15 2014 00:37:36 for Jafar by doxygen 1.7.6.1 |