#include <mrpt_localization_core.h>
Public Types | |
enum | PFStates { NA, INIT, RUN, IDLE } |
Public Member Functions | |
void | init () |
void | observation (CSensoryFrame::Ptr _sf, CObservationOdometry::Ptr _odometry) |
PFLocalizationCore () | |
~PFLocalizationCore () | |
Private Member Functions | |
void | initializeFilter () |
void | updateFilter (CActionCollection::Ptr _action, CSensoryFrame::Ptr _sf) |
Definition at line 56 of file mrpt_localization_core.h.
Enumerator | |
---|---|
NA | |
INIT | |
RUN | |
IDLE |
Definition at line 61 of file mrpt_localization_core.h.
PFLocalizationCore::PFLocalizationCore | ( | ) |
Definition at line 52 of file mrpt_localization_core.cpp.
PFLocalizationCore::~PFLocalizationCore | ( | ) |
Definition at line 51 of file mrpt_localization_core.cpp.
void PFLocalizationCore::init | ( | ) |
Initializes the parameter with common values to acive a working filter out of the box
Definition at line 53 of file mrpt_localization_core.cpp.
|
private |
Initializes the filter at pose PFLocalizationCore::initial_pose_ with PFLocalizationCore::initial_particle_count_ it is called by the PFLocalizationCore::updateFilter if the state_ == INIT
Definition at line 67 of file mrpt_localization_core.cpp.
void PFLocalizationCore::observation | ( | CSensoryFrame::Ptr | _sf, |
CObservationOdometry::Ptr | _odometry | ||
) |
preprocesses an observation and calls the update PFLocalizationCore::updateFilter If the odom data is null the function will assume a dummy odometry distribution around the last pose
_sf | sensor observation |
_odometry | the odom data can also be NULL |
Definition at line 123 of file mrpt_localization_core.cpp.
|
private |
Definition at line 113 of file mrpt_localization_core.cpp.
|
protected |
Definition at line 114 of file mrpt_localization_core.h.
|
protected |
Definition at line 116 of file mrpt_localization_core.h.
|
protected |
|
protected |
Definition at line 115 of file mrpt_localization_core.h.
|
protected |
Initial PDF mode: 0 for free space cells, 1 for
Definition at line 111 of file mrpt_localization_core.h.
|
protected |
number of particles for initialization
Definition at line 102 of file mrpt_localization_core.h.
|
protected |
initial posed used in initializeFilter()
Definition at line 101 of file mrpt_localization_core.h.
|
protected |
map
Definition at line 94 of file mrpt_localization_core.h.
|
protected |
used if there are is not odom
Definition at line 91 of file mrpt_localization_core.h.
|
protected |
used with odom value motion noise
Definition at line 93 of file mrpt_localization_core.h.
|
protected |
|
protected |
the filter
Definition at line 99 of file mrpt_localization_core.h.
|
protected |
common interface for particle filters
Definition at line 96 of file mrpt_localization_core.h.
|
protected |
filter statistics
Definition at line 98 of file mrpt_localization_core.h.
|
protected |
updates
filter states to perform things like init on the
Definition at line 107 of file mrpt_localization_core.h.
|
protected |
timer to measure performance
Definition at line 104 of file mrpt_localization_core.h.
|
protected |
time of the last update
Definition at line 103 of file mrpt_localization_core.h.
|
protected |
internal counter to count the number of filter
Definition at line 105 of file mrpt_localization_core.h.
|
protected |
used default odom_params
Definition at line 89 of file mrpt_localization_core.h.