Main MRPT website > C++ reference
MRPT logo
List of all members | Classes | Public Types | Public Member Functions | Protected Member Functions | Protected Attributes
mrpt::slam::CRejectionSamplingRangeOnlyLocalization Class Reference

Detailed Description

An implementation of rejection sampling for generating 2D robot pose from range-only measurements within a landmarks (beacons) map.

Before calling the method "rejectionSampling" to generate the samples, you must call "setParams". It is assumed a planar scenario, where the robot is at a fixed height (default=0).

See also
bayes::CRejectionSamplingCapable

Definition at line 35 of file CRejectionSamplingRangeOnlyLocalization.h.

#include <mrpt/slam/CRejectionSamplingRangeOnlyLocalization.h>

Inheritance diagram for mrpt::slam::CRejectionSamplingRangeOnlyLocalization:
Inheritance graph
[legend]

Classes

struct  TDataPerBeacon
 Data for each beacon observation with a correspondence with the map. More...
 

Public Types

typedef CProbabilityParticle< poses::CPose2DTParticle
 

Public Member Functions

 CRejectionSamplingRangeOnlyLocalization ()
 Constructor. More...
 
virtual ~CRejectionSamplingRangeOnlyLocalization ()
 Destructor. More...
 
bool setParams (const CLandmarksMap &beaconsMap, const CObservationBeaconRanges &observation, float sigmaRanges, const CPose2D &oldPose, float robot_z=0, bool autoCheckAngleRanges=true)
 The parameters used in the generation of random samples: More...
 
void rejectionSampling (size_t desiredSamples, std::vector< TParticle > &outSamples, size_t timeoutTrials=1000)
 Generates a set of N independent samples via rejection sampling. More...
 

Protected Member Functions

void RS_drawFromProposal (CPose2D &outSample)
 Generates one sample, drawing from some proposal distribution. More...
 
double RS_observationLikelihood (const CPose2D &x)
 Returns the NORMALIZED observation likelihood (linear, not exponential!!!) at a given point of the state space (values in the range [0,1]). More...
 

Protected Attributes

float m_z_robot
 Z coordinate of the robot. More...
 
float m_sigmaRanges
 
CPose2D m_oldPose
 
size_t m_drawIndex
 The index in "m_dataPerBeacon" used to draw samples (the rest will be used to evaluate the likelihood) More...
 
std::deque< TDataPerBeaconm_dataPerBeacon
 Data for each beacon observation with a correspondence with the map. More...
 

Member Typedef Documentation

◆ TParticle

Definition at line 31 of file CRejectionSamplingCapable.h.

Constructor & Destructor Documentation

◆ CRejectionSamplingRangeOnlyLocalization()

mrpt::slam::CRejectionSamplingRangeOnlyLocalization::CRejectionSamplingRangeOnlyLocalization ( )

Constructor.

◆ ~CRejectionSamplingRangeOnlyLocalization()

virtual mrpt::slam::CRejectionSamplingRangeOnlyLocalization::~CRejectionSamplingRangeOnlyLocalization ( )
inlinevirtual

Destructor.

Definition at line 45 of file CRejectionSamplingRangeOnlyLocalization.h.

Member Function Documentation

◆ rejectionSampling()

void mrpt::bayes::CRejectionSamplingCapable< poses::CPose2D >::rejectionSampling ( size_t  desiredSamples,
std::vector< TParticle > &  outSamples,
size_t  timeoutTrials = 1000 
)
inlineinherited

Generates a set of N independent samples via rejection sampling.

Parameters
desiredSamplesThe number of desired samples to generate
outSamplesThe output samples.
timeoutTrialsThe maximum number of rejection trials for each generated sample (i.e. the maximum number of iterations). This can be used to set a limit to the time complexity of the algorithm for difficult probability densities. All will have equal importance weights (a property of rejection sampling), although those samples generated at timeout will have a different importance weights.

Definition at line 46 of file CRejectionSamplingCapable.h.

References ASSERT_, MRPT_END, MRPT_START, mrpt::random::randomGenerator, mrpt::bayes::CRejectionSamplingCapable< TStateSpace >::RS_drawFromProposal(), and mrpt::bayes::CRejectionSamplingCapable< TStateSpace >::RS_observationLikelihood().

◆ RS_drawFromProposal()

void mrpt::slam::CRejectionSamplingRangeOnlyLocalization::RS_drawFromProposal ( CPose2D outSample)
protectedvirtual

Generates one sample, drawing from some proposal distribution.

Implements mrpt::bayes::CRejectionSamplingCapable< poses::CPose2D >.

◆ RS_observationLikelihood()

double mrpt::slam::CRejectionSamplingRangeOnlyLocalization::RS_observationLikelihood ( const CPose2D x)
protectedvirtual

Returns the NORMALIZED observation likelihood (linear, not exponential!!!) at a given point of the state space (values in the range [0,1]).

Implements mrpt::bayes::CRejectionSamplingCapable< poses::CPose2D >.

◆ setParams()

bool mrpt::slam::CRejectionSamplingRangeOnlyLocalization::setParams ( const CLandmarksMap beaconsMap,
const CObservationBeaconRanges observation,
float  sigmaRanges,
const CPose2D oldPose,
float  robot_z = 0,
bool  autoCheckAngleRanges = true 
)

The parameters used in the generation of random samples:

Parameters
beaconsMapThe map containing the N beacons (indexed by their "beacon ID"s). Only the mean 3D position of the beacons is used, the covariance is ignored.
observationAn observation with, at least ONE range measurement.
sigmaRangesThe standard deviation of the "range measurement noise".
robot_zThe height of the robot on the floor (default=0). Note that the beacon sensor on the robot may be at a different height, according to data within the observation object.
autoCheckAngleRangesWhether to make a simple check for potential good angles from the beacons to generate samples (disable to speed-up the preparation vs. making slower the drawn). This method fills out the member "m_dataPerBeacon".
Returns
true if at least ONE beacon has been successfully loaded, false otherwise. In this case do not call "rejectionSampling" or an exception will be launch, since there is no information to generate samples.

Member Data Documentation

◆ m_dataPerBeacon

std::deque<TDataPerBeacon> mrpt::slam::CRejectionSamplingRangeOnlyLocalization::m_dataPerBeacon
protected

Data for each beacon observation with a correspondence with the map.

Definition at line 99 of file CRejectionSamplingRangeOnlyLocalization.h.

◆ m_drawIndex

size_t mrpt::slam::CRejectionSamplingRangeOnlyLocalization::m_drawIndex
protected

The index in "m_dataPerBeacon" used to draw samples (the rest will be used to evaluate the likelihood)

Definition at line 82 of file CRejectionSamplingRangeOnlyLocalization.h.

◆ m_oldPose

CPose2D mrpt::slam::CRejectionSamplingRangeOnlyLocalization::m_oldPose
protected

Definition at line 78 of file CRejectionSamplingRangeOnlyLocalization.h.

◆ m_sigmaRanges

float mrpt::slam::CRejectionSamplingRangeOnlyLocalization::m_sigmaRanges
protected

Definition at line 77 of file CRejectionSamplingRangeOnlyLocalization.h.

◆ m_z_robot

float mrpt::slam::CRejectionSamplingRangeOnlyLocalization::m_z_robot
protected

Z coordinate of the robot.

Definition at line 75 of file CRejectionSamplingRangeOnlyLocalization.h.




Page generated by Doxygen 1.8.14 for MRPT 1.1.0 SVN: at lun oct 28 00:54:49 CET 2019 Hosted on:
SourceForge.net Logo