#include <Odometry.h>
Public Types | |
enum | Type { kTypeUndef = -1, kTypeLocalMap = 0, kTypeF2F = 1 } |
Public Member Functions | |
const Transform & | getPose () const |
bool | isInfoDataFilled () const |
double | previousStamp () const |
const Transform & | previousVelocityTransform () const |
Transform | process (SensorData &data, OdometryInfo *info=0) |
Transform | process (SensorData &data, const Transform &guess, OdometryInfo *info=0) |
virtual void | reset (const Transform &initialPose=Transform::getIdentity()) |
virtual | ~Odometry () |
Static Public Member Functions | |
static Odometry * | create (const ParametersMap ¶meters) |
static Odometry * | create (Type &type, const ParametersMap ¶meters=ParametersMap()) |
Protected Member Functions | |
Odometry (const rtabmap::ParametersMap ¶meters) | |
Private Member Functions | |
virtual Transform | computeTransform (SensorData &data, const Transform &guess=Transform(), OdometryInfo *info=0)=0 |
void | initKalmanFilter (const Transform &initialPose=Transform::getIdentity(), float vx=0.0f, float vy=0.0f, float vz=0.0f, float vroll=0.0f, float vpitch=0.0f, float vyaw=0.0f) |
void | predictKalmanFilter (float dt, float *vx=0, float *vy=0, float *vz=0, float *vroll=0, float *vpitch=0, float *vyaw=0) |
void | updateKalmanFilter (float &vx, float &vy, float &vz, float &vroll, float &vpitch, float &vyaw) |
Private Attributes | |
bool | _alignWithGround |
bool | _fillInfoData |
int | _filteringStrategy |
bool | _force3DoF |
bool | _holonomic |
int | _imageDecimation |
float | _kalmanMeasurementNoise |
float | _kalmanProcessNoise |
float | _particleLambdaR |
float | _particleLambdaT |
float | _particleNoiseR |
float | _particleNoiseT |
int | _particleSize |
Transform | _pose |
int | _resetCountdown |
int | _resetCurrentCount |
float | distanceTravelled_ |
bool | guessFromMotion_ |
cv::KalmanFilter | kalmanFilter_ |
std::vector< ParticleFilter * > | particleFilters_ |
Transform | previousGroundTruthPose_ |
double | previousStamp_ |
Transform | previousVelocityTransform_ |
Definition at line 42 of file Odometry.h.
Definition at line 45 of file Odometry.h.
rtabmap::Odometry::~Odometry | ( | ) | [virtual] |
Definition at line 135 of file Odometry.cpp.
rtabmap::Odometry::Odometry | ( | const rtabmap::ParametersMap & | parameters | ) | [protected] |
Definition at line 70 of file Odometry.cpp.
virtual Transform rtabmap::Odometry::computeTransform | ( | SensorData & | data, |
const Transform & | guess = Transform() , |
||
OdometryInfo * | info = 0 |
||
) | [private, pure virtual] |
Implemented in rtabmap::OdometryF2M, rtabmap::OdometryF2F, and rtabmap::OdometryMono.
Odometry * rtabmap::Odometry::create | ( | const ParametersMap & | parameters | ) | [static] |
Definition at line 45 of file Odometry.cpp.
Odometry * rtabmap::Odometry::create | ( | Odometry::Type & | type, |
const ParametersMap & | parameters = ParametersMap() |
||
) | [static] |
Definition at line 53 of file Odometry.cpp.
const Transform& rtabmap::Odometry::getPose | ( | ) | const [inline] |
Definition at line 62 of file Odometry.h.
void rtabmap::Odometry::initKalmanFilter | ( | const Transform & | initialPose = Transform::getIdentity() , |
float | vx = 0.0f , |
||
float | vy = 0.0f , |
||
float | vz = 0.0f , |
||
float | vroll = 0.0f , |
||
float | vpitch = 0.0f , |
||
float | vyaw = 0.0f |
||
) | [private] |
Definition at line 531 of file Odometry.cpp.
bool rtabmap::Odometry::isInfoDataFilled | ( | ) | const [inline] |
Definition at line 63 of file Odometry.h.
void rtabmap::Odometry::predictKalmanFilter | ( | float | dt, |
float * | vx = 0 , |
||
float * | vy = 0 , |
||
float * | vz = 0 , |
||
float * | vroll = 0 , |
||
float * | vpitch = 0 , |
||
float * | vyaw = 0 |
||
) | [private] |
Definition at line 623 of file Odometry.cpp.
double rtabmap::Odometry::previousStamp | ( | ) | const [inline] |
Definition at line 65 of file Odometry.h.
const Transform& rtabmap::Odometry::previousVelocityTransform | ( | ) | const [inline] |
Definition at line 64 of file Odometry.h.
Transform rtabmap::Odometry::process | ( | SensorData & | data, |
OdometryInfo * | info = 0 |
||
) |
Definition at line 196 of file Odometry.cpp.
Transform rtabmap::Odometry::process | ( | SensorData & | data, |
const Transform & | guess, | ||
OdometryInfo * | info = 0 |
||
) |
Definition at line 201 of file Odometry.cpp.
void rtabmap::Odometry::reset | ( | const Transform & | initialPose = Transform::getIdentity() | ) | [virtual] |
Reimplemented in rtabmap::OdometryF2M, rtabmap::OdometryF2F, and rtabmap::OdometryMono.
Definition at line 144 of file Odometry.cpp.
void rtabmap::Odometry::updateKalmanFilter | ( | float & | vx, |
float & | vy, | ||
float & | vz, | ||
float & | vroll, | ||
float & | vpitch, | ||
float & | vyaw | ||
) | [private] |
Definition at line 709 of file Odometry.cpp.
bool rtabmap::Odometry::_alignWithGround [private] |
Definition at line 89 of file Odometry.h.
bool rtabmap::Odometry::_fillInfoData [private] |
Definition at line 85 of file Odometry.h.
int rtabmap::Odometry::_filteringStrategy [private] |
Definition at line 79 of file Odometry.h.
bool rtabmap::Odometry::_force3DoF [private] |
Definition at line 76 of file Odometry.h.
bool rtabmap::Odometry::_holonomic [private] |
Definition at line 77 of file Odometry.h.
int rtabmap::Odometry::_imageDecimation [private] |
Definition at line 88 of file Odometry.h.
float rtabmap::Odometry::_kalmanMeasurementNoise [private] |
Definition at line 87 of file Odometry.h.
float rtabmap::Odometry::_kalmanProcessNoise [private] |
Definition at line 86 of file Odometry.h.
float rtabmap::Odometry::_particleLambdaR [private] |
Definition at line 84 of file Odometry.h.
float rtabmap::Odometry::_particleLambdaT [private] |
Definition at line 82 of file Odometry.h.
float rtabmap::Odometry::_particleNoiseR [private] |
Definition at line 83 of file Odometry.h.
float rtabmap::Odometry::_particleNoiseT [private] |
Definition at line 81 of file Odometry.h.
int rtabmap::Odometry::_particleSize [private] |
Definition at line 80 of file Odometry.h.
Transform rtabmap::Odometry::_pose [private] |
Definition at line 90 of file Odometry.h.
int rtabmap::Odometry::_resetCountdown [private] |
Definition at line 75 of file Odometry.h.
int rtabmap::Odometry::_resetCurrentCount [private] |
Definition at line 91 of file Odometry.h.
float rtabmap::Odometry::distanceTravelled_ [private] |
Definition at line 95 of file Odometry.h.
bool rtabmap::Odometry::guessFromMotion_ [private] |
Definition at line 78 of file Odometry.h.
cv::KalmanFilter rtabmap::Odometry::kalmanFilter_ [private] |
Definition at line 98 of file Odometry.h.
std::vector<ParticleFilter *> rtabmap::Odometry::particleFilters_ [private] |
Definition at line 97 of file Odometry.h.
Definition at line 94 of file Odometry.h.
double rtabmap::Odometry::previousStamp_ [private] |
Definition at line 92 of file Odometry.h.
Definition at line 93 of file Odometry.h.