Represents a probabilistic 2D movement of the robot mobile base.
See the tutorial on probabilistic motion models.
Definition at line 29 of file obs/CActionRobotMovement2D.h.
#include <mrpt/obs/CActionRobotMovement2D.h>
Classes | |
struct | TMotionModelOptions |
The parameter to be passed to "computeFromOdometry". More... | |
Public Types | |
enum | TEstimationMethod { emOdometry = 0, emScan2DMatching } |
A list of posible ways for estimating the content of a CActionRobotMovement2D object. More... | |
enum | TDrawSampleMotionModel { mmGaussian = 0, mmThrun } |
Public Member Functions | |
void * | operator new (size_t size) |
void * | operator new[] (size_t size) |
void | operator delete (void *ptr) throw () |
void | operator delete[] (void *ptr) throw () |
void | operator delete (void *memory, void *ptr) throw () |
void * | operator new (size_t size, const std::nothrow_t &) throw () |
void | operator delete (void *ptr, const std::nothrow_t &) throw () |
CActionRobotMovement2D () | |
Constructor. More... | |
CActionRobotMovement2D (const CActionRobotMovement2D &o) | |
Copy constructor. More... | |
CActionRobotMovement2D & | operator= (const CActionRobotMovement2D &o) |
Copy operator. More... | |
~CActionRobotMovement2D () | |
Destructor. More... | |
void | computeFromOdometry (const mrpt::poses::CPose2D &odometryIncrement, const TMotionModelOptions &options) |
Computes the PDF of the pose increment from an odometry reading and according to the given motion model (speed and encoder ticks information is not modified). More... | |
void | computeFromEncoders (double K_left, double K_right, double D) |
If "hasEncodersInfo"=true, this method updates the pose estimation according to the ticks from both encoders and the passed parameters, which is passed internally to the method "computeFromOdometry" with the last used PDF options (or the defualt ones if not explicitly called by the user). More... | |
void | drawSingleSample (mrpt::poses::CPose2D &outSample) const |
Using this method instead of "poseChange->drawSingleSample()" may be more efficient in most situations. More... | |
void | prepareFastDrawSingleSamples () const |
Call this before calling a high number of times "fastDrawSingleSample", which is much faster than "drawSingleSample". More... | |
void | fastDrawSingleSample (mrpt::poses::CPose2D &outSample) const |
Faster version than "drawSingleSample", but requires a previous call to "prepareFastDrawSingleSamples". More... | |
virtual mxArray * | writeToMatlab () const |
Introduces a pure virtual method responsible for writing to a mxArray Matlab object, typically a MATLAB struct whose contents are documented in each derived class. More... | |
mrpt::utils::CObjectPtr | duplicateGetSmartPtr () const |
Returns a copy of the object, indepently of its class, as a smart pointer (the newly created object will exist as long as any copy of this smart pointer). More... | |
CObject * | clone () const |
Cloning interface for smart pointers. More... | |
Static Public Member Functions | |
static void * | operator new (size_t size, void *ptr) |
Public Attributes | |
mrpt::poses::CPosePDFPtr | poseChange |
The 2D pose change probabilistic estimation. More... | |
mrpt::poses::CPose2D | rawOdometryIncrementReading |
This is the raw odometry reading, and only is used when "estimationMethod" is "TEstimationMethod::emOdometry". More... | |
TEstimationMethod | estimationMethod |
This fields indicates the way in which this estimation was obtained. More... | |
bool | hasEncodersInfo |
If "true" means that "encoderLeftTicks" and "encoderRightTicks" contain valid values. More... | |
int32_t | encoderLeftTicks |
For odometry only: the ticks count for each wheel FROM the last reading (positive means FORWARD, for both wheels);. More... | |
int32_t | encoderRightTicks |
bool | hasVelocities |
If "true" means that "velocityLin" and "velocityAng" contain valid values. More... | |
float | velocityLin |
float | velocityAng |
The velocity of the robot, linear in meters/sec and angular in rad/sec. More... | |
struct OBS_IMPEXP mrpt::obs::CActionRobotMovement2D::TMotionModelOptions | motionModelConfiguration |
mrpt::system::TTimeStamp | timestamp |
The associated time-stamp. More... | |
Static Public Attributes | |
static const mrpt::utils::TRuntimeClassId | classCObject |
RTTI stuff | |
static const mrpt::utils::TRuntimeClassId | classCAction |
RTTI stuff | |
static const mrpt::utils::TRuntimeClassId | classCSerializable |
Protected Member Functions | |
void | computeFromOdometry_modelGaussian (const mrpt::poses::CPose2D &odometryIncrement, const TMotionModelOptions &o) |
Computes the PDF of the pose increment from an odometry reading, using a Gaussian approximation as the motion model. More... | |
void | computeFromOdometry_modelThrun (const mrpt::poses::CPose2D &odometryIncrement, const TMotionModelOptions &o) |
Computes the PDF of the pose increment from an odometry reading, using the motion model from Thrun's book. More... | |
void | drawSingleSample_modelGaussian (mrpt::poses::CPose2D &outSample) const |
The sample generator for the model "computeFromOdometry_modelGaussian", internally called when the user invokes "drawSingleSample". More... | |
void | drawSingleSample_modelThrun (mrpt::poses::CPose2D &outSample) const |
The sample generator for the model "computeFromOdometry_modelThrun", internally called when the user invokes "drawSingleSample". More... | |
void | prepareFastDrawSingleSample_modelGaussian () const |
Internal use. More... | |
void | prepareFastDrawSingleSample_modelThrun () const |
Internal use. More... | |
void | fastDrawSingleSample_modelGaussian (mrpt::poses::CPose2D &outSample) const |
Internal use. More... | |
void | fastDrawSingleSample_modelThrun (mrpt::poses::CPose2D &outSample) const |
Internal use. More... | |
CSerializable virtual methods | |
void | writeToStream (mrpt::utils::CStream &out, int *getVersion) const |
Introduces a pure virtual method responsible for writing to a CStream. More... | |
void | readFromStream (mrpt::utils::CStream &in, int version) |
Introduces a pure virtual method responsible for loading from a CStream This can not be used directly be users, instead use "stream >> object;" for reading it from a stream or "stream >> object_ptr;" if the class is unknown apriori. More... | |
Protected Attributes | |
mrpt::math::CMatrixDouble33 | m_fastDrawGauss_Z |
Auxiliary matrix. More... | |
mrpt::poses::CPose2D | m_fastDrawGauss_M |
RTTI stuff | |
typedef CActionRobotMovement2DPtr | SmartPtr |
static mrpt::utils::CLASSINIT | _init_CActionRobotMovement2D |
static mrpt::utils::TRuntimeClassId | classCActionRobotMovement2D |
static const mrpt::utils::TRuntimeClassId * | classinfo |
static const mrpt::utils::TRuntimeClassId * | _GetBaseClass () |
virtual const mrpt::utils::TRuntimeClassId * | GetRuntimeClass () const |
Returns information about the class of an object in runtime. More... | |
virtual mrpt::utils::CObject * | duplicate () const |
Returns a copy of the object, indepently of its class. More... | |
static mrpt::utils::CObject * | CreateObject () |
static CActionRobotMovement2DPtr | Create () |
typedef CActionRobotMovement2DPtr mrpt::obs::CActionRobotMovement2D::SmartPtr |
A typedef for the associated smart pointer
Definition at line 32 of file obs/CActionRobotMovement2D.h.
Enumerator | |
---|---|
mmGaussian | |
mmThrun |
Definition at line 62 of file obs/CActionRobotMovement2D.h.
A list of posible ways for estimating the content of a CActionRobotMovement2D object.
Enumerator | |
---|---|
emOdometry | |
emScan2DMatching |
Definition at line 37 of file obs/CActionRobotMovement2D.h.
mrpt::obs::CActionRobotMovement2D::CActionRobotMovement2D | ( | ) |
Constructor.
mrpt::obs::CActionRobotMovement2D::CActionRobotMovement2D | ( | const CActionRobotMovement2D & | o | ) |
Copy constructor.
mrpt::obs::CActionRobotMovement2D::~CActionRobotMovement2D | ( | ) |
Destructor.
|
staticprotected |
|
inlineinherited |
void mrpt::obs::CActionRobotMovement2D::computeFromEncoders | ( | double | K_left, |
double | K_right, | ||
double | D | ||
) |
If "hasEncodersInfo"=true, this method updates the pose estimation according to the ticks from both encoders and the passed parameters, which is passed internally to the method "computeFromOdometry" with the last used PDF options (or the defualt ones if not explicitly called by the user).
K_left | The meters / tick ratio for the left encoder. |
K_right | The meters / tick ratio for the right encoder. |
D | The distance between both wheels, in meters. |
void mrpt::obs::CActionRobotMovement2D::computeFromOdometry | ( | const mrpt::poses::CPose2D & | odometryIncrement, |
const TMotionModelOptions & | options | ||
) |
Computes the PDF of the pose increment from an odometry reading and according to the given motion model (speed and encoder ticks information is not modified).
According to the parameters in the passed struct, it will be called one the private sampling functions (see "see also" next).
Referenced by mrpt::slam::PF_implementation< PARTICLE_TYPE, MYSELF >::PF_SLAM_implementation_gatherActionsCheckBothActObs().
|
protected |
Computes the PDF of the pose increment from an odometry reading, using a Gaussian approximation as the motion model.
|
protected |
Computes the PDF of the pose increment from an odometry reading, using the motion model from Thrun's book.
This model is discussed in "Probabilistic Robotics", Thrun, Burgard, and Fox, 2006, pp.136.
|
static |
|
static |
void mrpt::obs::CActionRobotMovement2D::drawSingleSample | ( | mrpt::poses::CPose2D & | outSample | ) | const |
Using this method instead of "poseChange->drawSingleSample()" may be more efficient in most situations.
|
protected |
The sample generator for the model "computeFromOdometry_modelGaussian", internally called when the user invokes "drawSingleSample".
|
protected |
The sample generator for the model "computeFromOdometry_modelThrun", internally called when the user invokes "drawSingleSample".
|
virtual |
Returns a copy of the object, indepently of its class.
Implements mrpt::utils::CObject.
|
inlineinherited |
void mrpt::obs::CActionRobotMovement2D::fastDrawSingleSample | ( | mrpt::poses::CPose2D & | outSample | ) | const |
Faster version than "drawSingleSample", but requires a previous call to "prepareFastDrawSingleSamples".
|
protected |
Internal use.
|
protected |
Internal use.
|
virtual |
Returns information about the class of an object in runtime.
Reimplemented from mrpt::obs::CAction.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inlinestatic |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
inline |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
CActionRobotMovement2D& mrpt::obs::CActionRobotMovement2D::operator= | ( | const CActionRobotMovement2D & | o | ) |
Copy operator.
|
protected |
Internal use.
|
protected |
Internal use.
void mrpt::obs::CActionRobotMovement2D::prepareFastDrawSingleSamples | ( | ) | const |
Call this before calling a high number of times "fastDrawSingleSample", which is much faster than "drawSingleSample".
|
protectedvirtual |
Introduces a pure virtual method responsible for loading from a CStream This can not be used directly be users, instead use "stream >> object;" for reading it from a stream or "stream >> object_ptr;" if the class is unknown apriori.
in | The input binary stream where the object data must read from. |
version | The version of the object stored in the stream: use this version number in your code to know how to read the incoming data. |
std::exception | On any error, see CStream::ReadBuffer |
Implements mrpt::utils::CSerializable.
|
inlinevirtualinherited |
Introduces a pure virtual method responsible for writing to a mxArray
Matlab object, typically a MATLAB struct
whose contents are documented in each derived class.
mxArray
(caller is responsible of memory freeing) or NULL is class does not support conversion to MATLAB. Definition at line 79 of file CSerializable.h.
References BASE_IMPEXP, DEFINE_MRPT_OBJECT_POST, mrpt::utils::ObjectToOctetVector(), mrpt::utils::ObjectToRawString(), mrpt::utils::ObjectToString(), mrpt::utils::OctetVectorToObject(), mrpt::utils::RawStringToObject(), and mrpt::utils::StringToObject().
|
protectedvirtual |
Introduces a pure virtual method responsible for writing to a CStream.
This can not be used directly be users, instead use "stream << object;" for writing it to a stream.
out | The output binary stream where object must be dumped. |
getVersion | If NULL, the object must be dumped. If not, only the version of the object dump must be returned in this pointer. This enables the versioning of objects dumping and backward compatibility with previously stored data. |
std::exception | On any error, see CStream::WriteBuffer |
Implements mrpt::utils::CSerializable.
|
staticprotected |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
staticinherited |
Definition at line 36 of file obs/CAction.h.
|
static |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
|
staticinherited |
|
staticinherited |
Definition at line 42 of file CSerializable.h.
|
static |
Definition at line 32 of file obs/CActionRobotMovement2D.h.
int32_t mrpt::obs::CActionRobotMovement2D::encoderLeftTicks |
For odometry only: the ticks count for each wheel FROM the last reading (positive means FORWARD, for both wheels);.
Definition at line 57 of file obs/CActionRobotMovement2D.h.
int32_t mrpt::obs::CActionRobotMovement2D::encoderRightTicks |
Definition at line 57 of file obs/CActionRobotMovement2D.h.
TEstimationMethod mrpt::obs::CActionRobotMovement2D::estimationMethod |
This fields indicates the way in which this estimation was obtained.
Definition at line 51 of file obs/CActionRobotMovement2D.h.
bool mrpt::obs::CActionRobotMovement2D::hasEncodersInfo |
If "true" means that "encoderLeftTicks" and "encoderRightTicks" contain valid values.
Definition at line 53 of file obs/CActionRobotMovement2D.h.
bool mrpt::obs::CActionRobotMovement2D::hasVelocities |
If "true" means that "velocityLin" and "velocityAng" contain valid values.
Definition at line 59 of file obs/CActionRobotMovement2D.h.
|
mutableprotected |
Definition at line 177 of file obs/CActionRobotMovement2D.h.
|
mutableprotected |
Auxiliary matrix.
Definition at line 176 of file obs/CActionRobotMovement2D.h.
struct OBS_IMPEXP mrpt::obs::CActionRobotMovement2D::TMotionModelOptions mrpt::obs::CActionRobotMovement2D::motionModelConfiguration |
mrpt::poses::CPosePDFPtr mrpt::obs::CActionRobotMovement2D::poseChange |
The 2D pose change probabilistic estimation.
Definition at line 48 of file obs/CActionRobotMovement2D.h.
Referenced by mrpt::slam::PF_implementation< PARTICLE_TYPE, MYSELF >::PF_SLAM_implementation_gatherActionsCheckBothActObs().
mrpt::poses::CPose2D mrpt::obs::CActionRobotMovement2D::rawOdometryIncrementReading |
This is the raw odometry reading, and only is used when "estimationMethod" is "TEstimationMethod::emOdometry".
Definition at line 50 of file obs/CActionRobotMovement2D.h.
|
inherited |
The associated time-stamp.
This was added at 2-Dec-2007, new serialization versions have been added to derived classes to manage this time-stamp. Prior versions will be read as having a INVALID_TIMESTAMP value.
Definition at line 50 of file obs/CAction.h.
float mrpt::obs::CActionRobotMovement2D::velocityAng |
The velocity of the robot, linear in meters/sec and angular in rad/sec.
Definition at line 60 of file obs/CActionRobotMovement2D.h.
float mrpt::obs::CActionRobotMovement2D::velocityLin |
Definition at line 60 of file obs/CActionRobotMovement2D.h.
Page generated by Doxygen 1.8.11 for MRPT 1.4.0 SVN: at Sun Aug 14 23:58:29 UTC 2016 |