MRPT
2.0.4
|
CRandomFieldGridMap2D represents a 2D grid map where each cell is associated one real-valued property which is estimated by this map, either as a simple value or as a probility distribution (for each cell).
There are a number of methods available to build the MRF grid-map, depending on the value of TMapRepresentation maptype
passed in the constructor.
The following papers describe the mapping alternatives implemented here:
mrKernelDM
: A Gaussian kernel-based method. See:mrKernelDMV
: A kernel-based method. See:mrKalmanFilter
: A "brute-force" approach to estimate the entire map with a dense (linear) Kalman filter. Will be very slow for mid or large maps. It's provided just for comparison purposes, not useful in practice.mrKalmanApproximate
: A compressed/sparse Kalman filter approach. See:mrGMRF_SD
: A Gaussian Markov Random Field (GMRF) estimator, with these constraints:mrGMRF_SD
: Each cell only connected to its 4 immediate neighbors (Up, down, left, right).mrGMRF_G
: Each cell connected to a square area of neighbors cells)Note that this class is virtual, since derived classes still have to implement:
[GMRF only] A custom connectivity pattern between cells can be defined by calling setCellsConnectivity().
Definition at line 152 of file CRandomFieldGridMap2D.h.
#include <mrpt/maps/CRandomFieldGridMap2D.h>
Classes | |
struct | ConnectivityDescriptor |
Base class for user-supplied objects capable of describing cells connectivity, used to build prior factors of the MRF graph. More... | |
struct | TInsertionOptionsCommon |
Parameters common to any derived class. More... | |
struct | TObservationGMRF |
struct | TPriorFactorGMRF |
Public Types | |
enum | TMapRepresentation { mrKernelDM = 0, mrAchim = 0, mrKalmanFilter, mrKalmanApproximate, mrKernelDMV, mrGMRF_SD } |
The type of map representation to be used, see CRandomFieldGridMap2D for a discussion. More... | |
enum | TGridInterpolationMethod { gimNearest = 0, gimBilinear } |
using | UniquePtr = std::unique_ptr< CObject > |
using | ConstUniquePtr = std::unique_ptr< const CObject > |
Public Member Functions | |
void | clear () |
Calls the base CMetricMap::clear Declared here to avoid ambiguity between the two clear() in both base classes. More... | |
float | cell2float (const TRandomFieldCell &c) const override |
CRandomFieldGridMap2D (TMapRepresentation mapType=mrKernelDM, double x_min=-2, double x_max=2, double y_min=-2, double y_max=2, double resolution=0.1) | |
Constructor. More... | |
~CRandomFieldGridMap2D () override | |
Destructor. More... | |
bool | isEmpty () const override |
Returns true if the map is empty/no observation has been inserted (in this class it always return false, unless redefined otherwise in base classes) More... | |
virtual void | saveAsBitmapFile (const std::string &filName) const |
Save the current map as a graphical file (BMP,PNG,...). More... | |
virtual void | getAsBitmapFile (mrpt::img::CImage &out_img) const |
Returns an image just as described in saveAsBitmapFile. More... | |
virtual void | getAsMatrix (mrpt::math::CMatrixDouble &out_mat) const |
Like saveAsBitmapFile(), but returns the data in matrix form (first row in the matrix is the upper (y_max) part of the map) More... | |
void | resize (double new_x_min, double new_x_max, double new_y_min, double new_y_max, const TRandomFieldCell &defaultValueNewCells, double additionalMarginMeters=1.0f) override |
Changes the size of the grid, maintaining previous contents. More... | |
virtual void | setSize (const double x_min, const double x_max, const double y_min, const double y_max, const double resolution, const TRandomFieldCell *fill_value=nullptr) |
Changes the size of the grid, erasing previous contents. More... | |
void | setCellsConnectivity (const ConnectivityDescriptor::Ptr &new_connectivity_descriptor) |
Sets a custom object to define the connectivity between cells. More... | |
float | compute3DMatchingRatio (const mrpt::maps::CMetricMap *otherMap, const mrpt::poses::CPose3D &otherMapPose, const TMatchingRatioParams ¶ms) const override |
See docs in base class: in this class this always returns 0. More... | |
void | saveMetricMapRepresentationToFile (const std::string &filNamePrefix) const override |
The implementation in this class just calls all the corresponding method of the contained metric maps. More... | |
virtual void | saveAsMatlab3DGraph (const std::string &filName) const |
Save a matlab ".m" file which represents as 3D surfaces the mean and a given confidence level for the concentration of each cell. More... | |
void | getAsMatlab3DGraphScript (std::string &out_script) const |
Return a large text block with a MATLAB script to plot the contents of this map. More... | |
void | getAs3DObject (mrpt::opengl::CSetOfObjects::Ptr &outObj) const override |
Returns a 3D object representing the map (mean) More... | |
virtual void | getAs3DObject (mrpt::opengl::CSetOfObjects::Ptr &meanObj, mrpt::opengl::CSetOfObjects::Ptr &varObj) const |
Returns two 3D objects representing the mean and variance maps. More... | |
TMapRepresentation | getMapType () |
Return the type of the random-field grid map, according to parameters passed on construction. More... | |
void | insertIndividualReading (const double sensorReading, const mrpt::math::TPoint2D &point, const bool update_map=true, const bool time_invariant=true, const double reading_stddev=.0) |
Direct update of the map with a reading in a given position of the map, using the appropriate method according to mapType passed in the constructor. More... | |
virtual void | predictMeasurement (const double x, const double y, double &out_predict_response, double &out_predict_response_variance, bool do_sensor_normalization, const TGridInterpolationMethod interp_method=gimNearest) |
Returns the prediction of the measurement at some (x,y) coordinates, and its certainty (in the form of the expected variance). More... | |
void | getMeanAndCov (mrpt::math::CVectorDouble &out_means, mrpt::math::CMatrixDouble &out_cov) const |
Return the mean and covariance vector of the full Kalman filter estimate (works for all KF-based methods). More... | |
void | getMeanAndSTD (mrpt::math::CVectorDouble &out_means, mrpt::math::CVectorDouble &out_STD) const |
Return the mean and STD vectors of the full Kalman filter estimate (works for all KF-based methods). More... | |
void | setMeanAndSTD (mrpt::math::CVectorDouble &out_means, mrpt::math::CVectorDouble &out_STD) |
Load the mean and STD vectors of the full Kalman filter estimate (works for all KF-based methods). More... | |
void | updateMapEstimation () |
Run the method-specific procedure required to ensure that the mean & variances are up-to-date with all inserted observations. More... | |
void | enableVerbose (bool enable_verbose) |
bool | isEnabledVerbose () const |
void | enableProfiler (bool enable=true) |
bool | isProfilerEnabled () const |
void | loadFromProbabilisticPosesAndObservations (const mrpt::maps::CSimpleMap &Map) |
Load the map contents from a CSimpleMap object, erasing all previous content of the map. More... | |
void | loadFromSimpleMap (const mrpt::maps::CSimpleMap &Map) |
! More... | |
bool | insertObservation (const mrpt::obs::CObservation &obs, const mrpt::poses::CPose3D *robotPose=nullptr) |
Insert the observation information into this map. More... | |
bool | insertObservationPtr (const mrpt::obs::CObservation::Ptr &obs, const mrpt::poses::CPose3D *robotPose=nullptr) |
A wrapper for smart pointers, just calls the non-smart pointer version. More... | |
double | computeObservationLikelihood (const mrpt::obs::CObservation &obs, const mrpt::poses::CPose3D &takenFrom) |
Computes the log-likelihood of a given observation given an arbitrary robot 3D pose. More... | |
double | computeObservationLikelihood (const mrpt::obs::CObservation &obs, const mrpt::poses::CPose2D &takenFrom) |
virtual bool | canComputeObservationLikelihood (const mrpt::obs::CObservation &obs) const |
Returns true if this map is able to compute a sensible likelihood function for this observation (i.e. More... | |
double | computeObservationsLikelihood (const mrpt::obs::CSensoryFrame &sf, const mrpt::poses::CPose2D &takenFrom) |
Returns the sum of the log-likelihoods of each individual observation within a mrpt::obs::CSensoryFrame. More... | |
bool | canComputeObservationsLikelihood (const mrpt::obs::CSensoryFrame &sf) const |
Returns true if this map is able to compute a sensible likelihood function for this observation (i.e. More... | |
virtual void | determineMatching2D (const mrpt::maps::CMetricMap *otherMap, const mrpt::poses::CPose2D &otherMapPose, mrpt::tfest::TMatchingPairList &correspondences, const TMatchingParams ¶ms, TMatchingExtraResults &extraResults) const |
Computes the matching between this and another 2D point map, which includes finding: More... | |
virtual void | determineMatching3D (const mrpt::maps::CMetricMap *otherMap, const mrpt::poses::CPose3D &otherMapPose, mrpt::tfest::TMatchingPairList &correspondences, const TMatchingParams ¶ms, TMatchingExtraResults &extraResults) const |
Computes the matchings between this and another 3D points map - method used in 3D-ICP. More... | |
virtual void | auxParticleFilterCleanUp () |
This method is called at the end of each "prediction-update-map
insertion" cycle within "mrpt::slam::CMetricMapBuilderRBPF::processActionObservation". More... | |
virtual float | squareDistanceToClosestCorrespondence (float x0, float y0) const |
Returns the square distance from the 2D point (x0,y0) to the closest correspondence in the map. More... | |
virtual const mrpt::maps::CSimplePointsMap * | getAsSimplePointsMap () const |
If the map is a simple points map or it's a multi-metric map that contains EXACTLY one simple points map, return it. More... | |
mrpt::maps::CSimplePointsMap * | getAsSimplePointsMap () |
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... | |
virtual CObject * | clone () const =0 |
Returns a deep copy (clone) of the object, indepently of its class. More... | |
void | setSize (const double x_min, const double x_max, const double y_min, const double y_max, const double resolution, const TRandomFieldCell *fill_value=nullptr) |
Changes the size of the grid, ERASING all previous contents. More... | |
void | fill (const TRandomFieldCell &value) |
Fills all the cells with the same value. More... | |
virtual void | resize (double new_x_min, double new_x_max, double new_y_min, double new_y_max, const TRandomFieldCell &defaultValueNewCells, double additionalMarginMeters=2.0) |
Changes the size of the grid, maintaining previous contents. More... | |
TRandomFieldCell * | cellByPos (double x, double y) |
Returns a pointer to the contents of a cell given by its coordinates, or nullptr if it is out of the map extensions. More... | |
const TRandomFieldCell * | cellByPos (double x, double y) const |
TRandomFieldCell * | cellByIndex (unsigned int cx, unsigned int cy) |
Returns a pointer to the contents of a cell given by its cell indexes, or nullptr if it is out of the map extensions. More... | |
const TRandomFieldCell * | cellByIndex (unsigned int cx, unsigned int cy) const |
Returns a pointer to the contents of a cell given by its cell indexes, or nullptr if it is out of the map extensions. More... | |
size_t | getSizeX () const |
Returns the horizontal size of grid map in cells count. More... | |
size_t | getSizeY () const |
Returns the vertical size of grid map in cells count. More... | |
double | getXMin () const |
Returns the "x" coordinate of left side of grid map. More... | |
double | getXMax () const |
Returns the "x" coordinate of right side of grid map. More... | |
double | getYMin () const |
Returns the "y" coordinate of top side of grid map. More... | |
double | getYMax () const |
Returns the "y" coordinate of bottom side of grid map. More... | |
double | getResolution () const |
Returns the resolution of the grid map. More... | |
int | x2idx (double x) const |
Transform a coordinate values into cell indexes. More... | |
int | y2idx (double y) const |
int | xy2idx (double x, double y) const |
void | idx2cxcy (int idx, int &cx, int &cy) const |
Transform a global (linear) cell index value into its corresponding (x,y) cell indexes. More... | |
double | idx2x (int cx) const |
Transform a cell index into a coordinate value of the cell central point. More... | |
double | idx2y (int cy) const |
void | getAsMatrix (MAT &m) const |
Get the entire grid as a matrix. More... | |
virtual float | cell2float (const TRandomFieldCell &) const |
The user must implement this in order to provide "saveToTextFile" a way to convert each cell into a numeric value. More... | |
bool | saveToTextFile (const std::string &fileName) const |
Saves a float representation of the grid (via "cell2float()") to a text file. More... | |
RTTI classes and functions for polymorphic hierarchies | |
mrpt::rtti::CObject::Ptr | duplicateGetSmartPtr () const |
Makes a deep copy of the object and returns a smart pointer to it. More... | |
Static Public Member Functions | |
static std::array< mrpt::system::TConsoleColor, NUMBER_OF_VERBOSITY_LEVELS > & | logging_levels_to_colors () |
Map from VerbosityLevels to their corresponding mrpt::system::TConsoleColor. More... | |
static std::array< std::string, NUMBER_OF_VERBOSITY_LEVELS > & | logging_levels_to_names () |
Map from VerbosityLevels to their corresponding names. More... | |
Public Attributes | |
TMapGenericParams | genericMapParams |
Common params to all maps. More... | |
Protected Member Functions | |
virtual CRandomFieldGridMap2D::TInsertionOptionsCommon * | getCommonInsertOptions ()=0 |
Get the part of the options common to all CRandomFieldGridMap2D classes. More... | |
void | insertObservation_KernelDM_DMV (double normReading, const mrpt::math::TPoint2D &point, bool is_DMV) |
The implementation of "insertObservation" for Achim Lilienthal's map models DM & DM+V. More... | |
void | insertObservation_KF (double normReading, const mrpt::math::TPoint2D &point) |
The implementation of "insertObservation" for the (whole) Kalman Filter map model. More... | |
void | insertObservation_KF2 (double normReading, const mrpt::math::TPoint2D &point) |
The implementation of "insertObservation" for the Efficient Kalman Filter map model. More... | |
void | insertObservation_GMRF (double normReading, const mrpt::math::TPoint2D &point, const bool update_map, const bool time_invariant, const double reading_information) |
The implementation of "insertObservation" for the Gaussian Markov Random Field map model. More... | |
void | updateMapEstimation_GMRF () |
solves the minimum quadratic system to determine the new concentration of each cell More... | |
double | computeConfidenceCellValue_DM_DMV (const TRandomFieldCell *cell) const |
Computes the confidence of the cell concentration (alpha) More... | |
double | computeMeanCellValue_DM_DMV (const TRandomFieldCell *cell) const |
Computes the average cell concentration, or the overall average value if it has never been observed. More... | |
double | computeVarCellValue_DM_DMV (const TRandomFieldCell *cell) const |
Computes the estimated variance of the cell concentration, or the overall average variance if it has never been observed. More... | |
void | recoverMeanAndCov () const |
In the KF2 implementation, takes the auxiliary matrices and from them update the cells' mean and std values. More... | |
void | internal_clear () override |
Erase all the contents of the map. More... | |
bool | exist_relation_between2cells (const mrpt::maps::COccupancyGridMap2D *m_Ocgridmap, size_t cxo_min, size_t cxo_max, size_t cyo_min, size_t cyo_max, const size_t seed_cxo, const size_t seed_cyo, const size_t objective_cxo, const size_t objective_cyo) |
Check if two cells of the gridmap (m_map) are connected, based on the provided occupancy gridmap. More... | |
void | publishEvent (const mrptEvent &e) const |
Called when you want this object to emit an event to all the observers currently subscribed to this object. More... | |
bool | hasSubscribers () const |
Can be called by a derived class before preparing an event for publishing with publishEvent to determine if there is no one subscribed, so it can save the wasted time preparing an event that will be not read. More... | |
std::vector< TRandomFieldCell > & | m_map_castaway_const () const |
Used only from logically const method that really need to modify the object. More... | |
void | dyngridcommon_writeToStream (STREAM &out) const |
void | dyngridcommon_readFromStream (STREAM &in, bool cast_from_float=false) |
CSerializable virtual methods | |
virtual uint8_t | serializeGetVersion () const =0 |
Must return the current versioning number of the object. More... | |
virtual void | serializeTo (CArchive &out) const =0 |
Pure virtual method for writing (serializing) to an abstract archive. More... | |
virtual void | serializeTo (CSchemeArchiveBase &out) const |
Virtual method for writing (serializing) to an abstract schema based archive. More... | |
virtual void | serializeFrom (CArchive &in, uint8_t serial_version)=0 |
Pure virtual method for reading (deserializing) from an abstract archive. More... | |
virtual void | serializeFrom (CSchemeArchiveBase &in) |
Virtual method for reading (deserializing) from an abstract schema based archive. More... | |
Protected Attributes | |
bool | m_rfgm_run_update_upon_clear {true} |
TInsertionOptionsCommon * | m_insertOptions_common {nullptr} |
Common options to all random-field grid maps: pointer that is set to the derived-class instance of "insertOptions" upon construction of this class. More... | |
TMapRepresentation | m_mapType |
The map representation type of this map, as passed in the constructor. More... | |
mrpt::math::CMatrixD | m_cov |
The whole covariance matrix, used for the Kalman Filter map representation. More... | |
mrpt::math::CMatrixD | m_stackedCov |
The compressed band diagonal matrix for the KF2 implementation. More... | |
bool | m_hasToRecoverMeanAndCov {true} |
Only for the KF2 implementation. More... | |
ConnectivityDescriptor::Ptr | m_gmrf_connectivity |
Empty: default. More... | |
mrpt::graphs::ScalarFactorGraph | m_gmrf |
std::vector< std::list< TObservationGMRF > > | m_mrf_factors_activeObs |
Vector with the active observations and their respective Information. More... | |
std::deque< TPriorFactorGMRF > | m_mrf_factors_priors |
Vector with the precomputed priors for each GMRF model. More... | |
std::vector< TRandomFieldCell > | m_map |
The cells. More... | |
double | m_x_min |
double | m_x_max |
double | m_y_min |
double | m_y_max |
double | m_resolution |
size_t | m_size_x |
size_t | m_size_y |
VerbosityLevel | m_min_verbosity_level {LVL_INFO} |
Provided messages with VerbosityLevel smaller than this value shall be ignored. More... | |
Auxiliary vars for DM & DM+V methods | |
float | m_DM_lastCutOff {0} |
std::vector< float > | m_DM_gaussWindow |
double | m_average_normreadings_mean {0} |
double | m_average_normreadings_var {0} |
size_t | m_average_normreadings_count {0} |
Private Types | |
using | BASE = mrpt::containers::CDynamicGrid< TRandomFieldCell > |
RTTI stuff | |
using | Ptr = std::shared_ptr< CRandomFieldGridMap2D > |
using | ConstPtr = std::shared_ptr< const CRandomFieldGridMap2D > |
static const mrpt::rtti::TRuntimeClassId | runtimeClassId |
static const mrpt::rtti::TRuntimeClassId * | _GetBaseClass () |
virtual const mrpt::rtti::TRuntimeClassId * | GetRuntimeClass () const override |
Returns information about the class of an object in runtime. More... | |
static const mrpt::rtti::TRuntimeClassId & | GetRuntimeClassIdStatic () |
Logging methods | |
void | logStr (const VerbosityLevel level, std::string_view msg_str) const |
Main method to add the specified message string to the logger. More... | |
void | logFmt (const VerbosityLevel level, const char *fmt,...) const MRPT_printf_format_check(3 |
Alternative logging method, which mimics the printf behavior. More... | |
void void | logCond (const VerbosityLevel level, bool cond, const std::string &msg_str) const |
Log the given message only if the condition is satisfied. More... | |
void | setLoggerName (const std::string &name) |
Set the name of the COutputLogger instance. More... | |
std::string | getLoggerName () const |
Return the name of the COutputLogger instance. More... | |
void | setMinLoggingLevel (const VerbosityLevel level) |
Set the minimum logging level for which the incoming logs are going to be taken into account. More... | |
void | setVerbosityLevel (const VerbosityLevel level) |
alias of setMinLoggingLevel() More... | |
VerbosityLevel | getMinLoggingLevel () const |
bool | isLoggingLevelVisible (VerbosityLevel level) const |
void | getLogAsString (std::string &log_contents) const |
Fill the provided string with the contents of the logger's history in std::string representation. More... | |
std::string | getLogAsString () const |
Get the history of COutputLogger instance in a string representation. More... | |
void | writeLogToFile (const std::string *fname_in=nullptr) const |
Write the contents of the COutputLogger instance to an external file. More... | |
void | dumpLogToConsole () const |
Dump the current contents of the COutputLogger instance in the terminal window. More... | |
std::string | getLoggerLastMsg () const |
Return the last Tmsg instance registered in the logger history. More... | |
void | getLoggerLastMsg (std::string &msg_str) const |
Fill inputtted string with the contents of the last message in history. More... | |
void | loggerReset () |
Reset the contents of the logger instance. More... | |
void | logRegisterCallback (output_logger_callback_t userFunc) |
bool | logDeregisterCallback (output_logger_callback_t userFunc) |
bool | logging_enable_console_output {true} |
[Default=true] Set it to false in case you don't want the logged messages to be dumped to the output automatically. More... | |
bool | logging_enable_keep_record {false} |
[Default=false] Enables storing all messages into an internal list. More... | |
|
private |
Definition at line 157 of file CRandomFieldGridMap2D.h.
Definition at line 159 of file CRandomFieldGridMap2D.h.
|
inherited |
Definition at line 159 of file CRandomFieldGridMap2D.h.
|
inherited |
Enumerator | |
---|---|
gimNearest | |
gimBilinear |
Definition at line 426 of file CRandomFieldGridMap2D.h.
The type of map representation to be used, see CRandomFieldGridMap2D for a discussion.
Enumerator | |
---|---|
mrKernelDM | Gaussian kernel-based estimator (see discussion in mrpt::maps::CRandomFieldGridMap2D) |
mrAchim | Another alias for "mrKernelDM", for backwards compatibility (see discussion in mrpt::maps::CRandomFieldGridMap2D) |
mrKalmanFilter | "Brute-force" Kalman filter (see discussion in mrpt::maps::CRandomFieldGridMap2D) |
mrKalmanApproximate | (see discussion in mrpt::maps::CRandomFieldGridMap2D) |
mrKernelDMV | Double mean + variance Gaussian kernel-based estimator (see discussion in mrpt::maps::CRandomFieldGridMap2D) |
mrGMRF_SD | Gaussian Markov Random Field, squared differences prior weights between 4 neighboring cells (see discussion in mrpt::maps::CRandomFieldGridMap2D) |
Definition at line 175 of file CRandomFieldGridMap2D.h.
CRandomFieldGridMap2D::CRandomFieldGridMap2D | ( | TMapRepresentation | mapType = mrKernelDM , |
double | x_min = -2 , |
||
double | x_max = 2 , |
||
double | y_min = -2 , |
||
double | y_max = 2 , |
||
double | resolution = 0.1 |
||
) |
Constructor.
Definition at line 44 of file CRandomFieldGridMap2D.cpp.
|
overridedefault |
Destructor.
|
staticprotected |
|
inlinevirtualinherited |
This method is called at the end of each "prediction-update-map insertion" cycle within "mrpt::slam::CMetricMapBuilderRBPF::processActionObservation".
This method should normally do nothing, but in some cases can be used to free auxiliary cached variables.
Reimplemented in mrpt::maps::CLandmarksMap, and mrpt::maps::CMultiMetricMap.
Definition at line 282 of file CMetricMap.h.
|
virtualinherited |
Returns true if this map is able to compute a sensible likelihood function for this observation (i.e.
an occupancy grid map cannot with an image). See: Maps and observations compatibility matrix
obs | The observation. |
Definition at line 161 of file CMetricMap.cpp.
|
inherited |
Returns true if this map is able to compute a sensible likelihood function for this observation (i.e.
an occupancy grid map cannot with an image). See: Maps and observations compatibility matrix
sf | The observations. |
Definition at line 85 of file CMetricMap.cpp.
References mrpt::obs::CSensoryFrame::begin(), and mrpt::obs::CSensoryFrame::end().
|
inlineoverride |
Definition at line 167 of file CRandomFieldGridMap2D.h.
References mrpt::d2f(), and mrpt::maps::TRandomFieldCell::kf_mean().
|
inlinevirtualinherited |
The user must implement this in order to provide "saveToTextFile" a way to convert each cell into a numeric value.
Definition at line 310 of file CDynamicGrid.h.
|
inlineinherited |
Returns a pointer to the contents of a cell given by its cell indexes, or nullptr if it is out of the map extensions.
Definition at line 222 of file CDynamicGrid.h.
Referenced by getAs3DObject(), getAsMatrix(), predictMeasurement(), saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
inlineinherited |
Returns a pointer to the contents of a cell given by its cell indexes, or nullptr if it is out of the map extensions.
Definition at line 233 of file CDynamicGrid.h.
|
inlineinherited |
Returns a pointer to the contents of a cell given by its coordinates, or nullptr if it is out of the map extensions.
Definition at line 201 of file CDynamicGrid.h.
Referenced by insertObservation_GMRF(), insertObservation_KF(), and insertObservation_KF2().
|
inlineinherited |
This is an overloaded member function, provided for convenience. It differs from the above function only in what argument(s) it accepts.
Definition at line 210 of file CDynamicGrid.h.
|
inline |
Calls the base CMetricMap::clear Declared here to avoid ambiguity between the two clear() in both base classes.
Definition at line 165 of file CRandomFieldGridMap2D.h.
References mrpt::maps::CMetricMap::clear().
|
pure virtualinherited |
Returns a deep copy (clone) of the object, indepently of its class.
Implemented in mrpt::obs::CObservation3DRangeScan, mrpt::nav::CLogFileRecord_ND, mrpt::nav::CLogFileRecord_FullEval, mrpt::img::CImage, mrpt::maps::CMultiMetricMap, mrpt::obs::CObservationIMU, mrpt::poses::CPose3D, mrpt::obs::CObservationRGBD360, mrpt::obs::CObservationVelodyneScan, mrpt::maps::TMapGenericParams, mrpt::maps::CRandomFieldGridMap3D, mrpt::hmtslam::THypothesisIDSet, mrpt::detectors::CDetectable3D, mrpt::maps::CLandmarksMap, mrpt::hmtslam::CHMTSLAM, mrpt::hmtslam::CLocalMetricHypothesis, mrpt::opengl::COctoMapVoxels, mrpt::kinematics::CKinematicChain, mrpt::obs::CObservationGPS, mrpt::maps::CMultiMetricMapPDF, mrpt::maps::CHeightGridMap2D, mrpt::obs::CRawlog, mrpt::opengl::COpenGLViewport, mrpt::obs::CObservationRotatingScan, mrpt::opengl::CPlanarLaserScan, mrpt::nav::CHolonomicFullEval, mrpt::opengl::COpenGLScene, mrpt::slam::CIncrementalMapPartitioner, mrpt::vision::CFeature, mrpt::maps::COccupancyGridMap2D, mrpt::obs::CObservation2DRangeScan, mrpt::opengl::CFrustum, mrpt::nav::CHolonomicND, mrpt::obs::CSensoryFrame, mrpt::poses::CPose2DInterpolator, mrpt::opengl::CEllipsoidInverseDepth3D, mrpt::poses::CPose3DInterpolator, mrpt::nav::CHolonomicVFF, mrpt::opengl::CPointCloud, mrpt::opengl::CPointCloudColoured, mrpt::poses::CPose3DQuat, mrpt::opengl::CPolyhedron, mrpt::hmtslam::CLSLAMParticleData, mrpt::opengl::CEllipsoidInverseDepth2D, mrpt::detectors::CDetectable2D, mrpt::maps::CBeaconMap, mrpt::opengl::CAngularObservationMesh, mrpt::opengl::CAssimpModel, mrpt::poses::CPose3DQuatPDFGaussian, mrpt::poses::CPose3DQuatPDFGaussianInf, mrpt::opengl::CEllipsoidRangeBearing2D, mrpt::opengl::CText3D, mrpt::maps::COctoMap, mrpt::opengl::CBox, mrpt::opengl::CEllipsoid2D, mrpt::poses::CPose2D, mrpt::maps::CReflectivityGridMap2D, mrpt::nav::CPTG_DiffDrive_C, mrpt::opengl::CEllipsoid3D, mrpt::poses::CPose3DPDFGaussianInf, mrpt::opengl::CVectorField3D, mrpt::poses::CPose3DPDFGaussian, mrpt::maps::CColouredOctoMap, mrpt::obs::CObservationStereoImages, mrpt::opengl::CMesh, mrpt::opengl::CMeshFast, mrpt::poses::CPosePDFParticles, MyNS::Bar, mrpt::hmtslam::CHMHMapNode, mrpt::hmtslam::CRobotPosesGraph, mrpt::opengl::CMesh3D, mrpt::opengl::CVectorField2D, mrpt::poses::CPose3DPDFParticles, mrpt::hmtslam::CMHPropertiesValuesList, mrpt::obs::CObservationStereoImagesFeatures, mrpt::opengl::CColorBar, mrpt::maps::CBeacon, mrpt::maps::COccupancyGridMap3D, mrpt::nav::CPTG_DiffDrive_alpha, mrpt::opengl::CText, mrpt::maps::CRBPFParticleData, mrpt::maps::CLandmark, mrpt::maps::CHeightGridMap2D_MRF, mrpt::opengl::CCamera, mrpt::poses::CPosePDFGaussianInf, mrpt::poses::CPosePDFSOG, mrpt::hmtslam::CHMHMapArc, mrpt::obs::CObservationPointCloud, mrpt::opengl::CSetOfLines, mrpt::poses::CPoint2D, mrpt::poses::CPointPDFSOG, mrpt::maps::CGasConcentrationGridMap2D, mrpt::maps::CWirelessPowerGridMap2D, mrpt::maps::CSimpleMap, mrpt::obs::CObservationImage, mrpt::poses::CPoint3D, mrpt::poses::CPose3DPDFSOG, mrpt::obs::CObservationBatteryState, mrpt::hmtslam::CHierarchicalMHMap, mrpt::maps::CSimplePointsMap, mrpt::obs::CActionRobotMovement2D, mrpt::opengl::CDisk, mrpt::maps::CColouredPointsMap, mrpt::maps::CWeightedPointsMap, mrpt::nav::CLogFileRecord, mrpt::obs::CObservationOdometry, mrpt::obs::CObservationRawDAQ, mrpt::opengl::CAxis, mrpt::opengl::CCylinder, mrpt::opengl::CGridPlaneXY, mrpt::opengl::CGridPlaneXZ, mrpt::opengl::CSphere, mrpt::poses::CPointPDFParticles, mrpt::obs::CObservationBearingRange, mrpt::obs::CObservationWindSensor, mrpt::opengl::CArrow, mrpt::poses::CPosePDFGaussian, MyNS::MyDerived2, mrpt::obs::CObservationRange, mrpt::img::TCamera, mrpt::maps::CPointsMapXYZI, mrpt::nav::CMultiObjMotionOpt_Scalarization, mrpt::nav::CPTG_Holo_Blend, mrpt::obs::CActionCollection, mrpt::obs::CActionRobotMovement3D, mrpt::obs::CObservationWirelessPower, mrpt::opengl::CSetOfObjects, mrpt::nav::CLogFileRecord_VFF, mrpt::nav::CPTG_DiffDrive_CC, mrpt::nav::CPTG_DiffDrive_CCS, mrpt::nav::CPTG_DiffDrive_CS, mrpt::obs::CObservation6DFeatures, mrpt::obs::CObservationSkeleton, mrpt::poses::CPose3DPDFGrid, mrpt::obs::CObservationVisualLandmarks, mrpt::math::CMatrixD, mrpt::math::CSplineInterpolator1D, mrpt::obs::CObservationBeaconRanges, mrpt::obs::CObservationComment, mrpt::obs::CObservationGasSensors, mrpt::obs::CObservationReflectivity, mrpt::obs::CObservationRFID, mrpt::poses::CPosePDFGrid, mrpt::poses::CPoses2DSequence, mrpt::img::TStereoCamera, mrpt::poses::CPoses3DSequence, mrpt::math::CMatrixF, mrpt::opengl::CSetOfTriangles, mrpt::poses::CPointPDFGaussian, mrpt::hmtslam::CPropertiesValuesList, mrpt::math::CMatrixB, mrpt::obs::CObservationCANBusJ1939, mrpt::obs::CObservationRobotPose, mrpt::opengl::CSetOfTexturedTriangles, MyNS::MyDerived1, mrpt::math::CPolygon, mrpt::opengl::CTexturedPlane, mrpt::poses::CPoint2DPDFGaussian, MyNS::Foo, mrpt::kinematics::CVehicleVelCmd_DiffDriven, mrpt::kinematics::CVehicleVelCmd_Holo, mrpt::opengl::CSimpleLine, and MyNS::Foo.
Referenced by mrpt::rtti::CObject::duplicateGetSmartPtr(), mrpt::maps::CSimpleMap::insert(), mrpt::obs::CActionCollection::insert(), and mrpt::poses::CPoseRandomSampler::setPosePDF().
|
overridevirtual |
See docs in base class: in this class this always returns 0.
Reimplemented from mrpt::maps::CMetricMap.
Definition at line 2709 of file CRandomFieldGridMap2D.cpp.
|
protected |
Computes the confidence of the cell concentration (alpha)
Definition at line 1972 of file CRandomFieldGridMap2D.cpp.
References mrpt::maps::TRandomFieldCell::dm_mean_w(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::dm_sigma_omega, m_insertOptions_common, and mrpt::square().
Referenced by saveMetricMapRepresentationToFile().
|
protected |
Computes the average cell concentration, or the overall average value if it has never been observed.
Definition at line 1984 of file CRandomFieldGridMap2D.cpp.
References mrpt::maps::TRandomFieldCell::dm_mean(), mrpt::maps::TRandomFieldCell::dm_mean_w(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::dm_sigma_omega, m_average_normreadings_mean, m_insertOptions_common, and mrpt::square().
Referenced by getAs3DObject(), getAsMatrix(), predictMeasurement(), and saveMetricMapRepresentationToFile().
|
inherited |
Computes the log-likelihood of a given observation given an arbitrary robot 3D pose.
See: Maps and observations compatibility matrix
takenFrom | The robot's pose the observation is supposed to be taken from. |
obs | The observation. |
Definition at line 170 of file CMetricMap.cpp.
Referenced by mrpt::maps::CMultiMetricMapPDF::PF_SLAM_computeObservationLikelihoodForParticle().
|
inherited |
This is an overloaded member function, provided for convenience. It differs from the above function only in what argument(s) it accepts.
Definition at line 76 of file CMetricMap.cpp.
|
inherited |
Returns the sum of the log-likelihoods of each individual observation within a mrpt::obs::CSensoryFrame.
See: Maps and observations compatibility matrix
takenFrom | The robot's pose the observation is supposed to be taken from. |
sf | The set of observations in a CSensoryFrame. |
Definition at line 66 of file CMetricMap.cpp.
Referenced by mrpt::hmtslam::CLSLAM_RBPF_2DLASER::auxiliarComputeObservationLikelihood().
|
protected |
Computes the estimated variance of the cell concentration, or the overall average variance if it has never been observed.
Definition at line 1999 of file CRandomFieldGridMap2D.cpp.
References mrpt::maps::TRandomFieldCell::dm_mean_w(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::dm_sigma_omega, mrpt::maps::TRandomFieldCell::dmv_var_mean, m_average_normreadings_var, m_insertOptions_common, and mrpt::square().
Referenced by getAs3DObject(), predictMeasurement(), and saveMetricMapRepresentationToFile().
|
virtualinherited |
Computes the matching between this and another 2D point map, which includes finding:
The algorithm is:
This method is the most time critical one into ICP-like algorithms.
otherMap | [IN] The other map to compute the matching with. |
otherMapPose | [IN] The pose of the other map as seen from "this". |
params | [IN] Parameters for the determination of pairings. |
correspondences | [OUT] The detected matchings pairs. |
extraResults | [OUT] Other results. |
Reimplemented in mrpt::maps::COccupancyGridMap2D, mrpt::maps::CPointsMap, mrpt::maps::COccupancyGridMap3D, mrpt::maps::CBeaconMap, and mrpt::maps::CMultiMetricMap.
Definition at line 119 of file CMetricMap.cpp.
References MRPT_END, MRPT_START, and THROW_EXCEPTION.
Referenced by mrpt::slam::CICP::ICP_Method_Classic().
|
virtualinherited |
Computes the matchings between this and another 3D points map - method used in 3D-ICP.
This method finds the set of point pairs in each map.
The method is the most time critical one into ICP-like algorithms.
The algorithm is:
otherMap | [IN] The other map to compute the matching with. |
otherMapPose | [IN] The pose of the other map as seen from "this". |
params | [IN] Parameters for the determination of pairings. |
correspondences | [OUT] The detected matchings pairs. |
extraResults | [OUT] Other results. |
Reimplemented in mrpt::maps::CPointsMap.
Definition at line 131 of file CMetricMap.cpp.
References MRPT_END, MRPT_START, and THROW_EXCEPTION.
Referenced by mrpt::slam::CICP::ICP3D_Method_Classic().
|
inherited |
Dump the current contents of the COutputLogger instance in the terminal window.
Definition at line 190 of file COutputLogger.cpp.
|
inlineinherited |
Makes a deep copy of the object and returns a smart pointer to it.
Definition at line 204 of file CObject.h.
References mrpt::rtti::CObject::clone().
Referenced by mrpt::obs::CRawlog::insert().
|
inlineprotectedinherited |
Definition at line 342 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), and mrpt::maps::CWirelessPowerGridMap2D::serializeFrom().
|
inlineprotectedinherited |
Definition at line 334 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), and mrpt::maps::CWirelessPowerGridMap2D::serializeTo().
|
inline |
Definition at line 480 of file CRandomFieldGridMap2D.h.
References mrpt::graphs::ScalarFactorGraph::enableProfiler(), and m_gmrf.
|
inline |
Definition at line 471 of file CRandomFieldGridMap2D.h.
References mrpt::system::LVL_DEBUG, and mrpt::system::COutputLogger::setMinLoggingLevel().
|
protected |
Check if two cells of the gridmap (m_map) are connected, based on the provided occupancy gridmap.
Definition at line 2596 of file CRandomFieldGridMap2D.cpp.
References mrpt::math::CMatrixDynamic< T >::cols(), mrpt::math::MatrixVectorBase< Scalar, Derived >::fill(), mrpt::maps::COccupancyGridMap2D::getCell(), mrpt::maps::COccupancyGridMap2D::getSizeX(), mrpt::maps::COccupancyGridMap2D::getSizeY(), and mrpt::math::CMatrixDynamic< T >::rows().
|
inlineinherited |
Fills all the cells with the same value.
Definition at line 109 of file CDynamicGrid.h.
|
overridevirtual |
Returns a 3D object representing the map (mean)
Implements mrpt::maps::CMetricMap.
Reimplemented in mrpt::maps::CWirelessPowerGridMap2D.
Definition at line 1586 of file CRandomFieldGridMap2D.cpp.
References mrpt::opengl::CSetOfObjects::Create(), mrpt::maps::TMapGenericParams::enableSaveAs3DObject, and mrpt::maps::CMetricMap::genericMapParams.
Referenced by mrpt::maps::CHeightGridMap2D_MRF::getAs3DObject(), mrpt::maps::CWirelessPowerGridMap2D::getAs3DObject(), and mrpt::maps::CGasConcentrationGridMap2D::getAs3DObject().
|
virtual |
Returns two 3D objects representing the mean and variance maps.
Reimplemented in mrpt::maps::CGasConcentrationGridMap2D, and mrpt::maps::CHeightGridMap2D_MRF.
Definition at line 1600 of file CRandomFieldGridMap2D.cpp.
References mrpt::opengl::TTriangle::a(), ASSERT_, mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByIndex(), mrpt::img::cmJET, mrpt::img::colormap(), computeMeanCellValue_DM_DMV(), computeVarCellValue_DM_DMV(), mrpt::maps::TMapGenericParams::enableSaveAs3DObject, mrpt::maps::CMetricMap::genericMapParams, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_max, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_min, mrpt::maps::TRandomFieldCell::kf_mean(), mrpt::maps::TRandomFieldCell::kf_std(), m_insertOptions_common, m_mapType, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_resolution, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_y, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_min, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_min, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, mrKernelDM, mrKernelDMV, recoverMeanAndCov(), mrpt::saturate_val(), mrpt::square(), mrpt::opengl::TTriangle::vertices, mrpt::opengl::TTriangle::x(), mrpt::opengl::TTriangle::y(), and mrpt::opengl::TTriangle::z().
|
virtual |
Returns an image just as described in saveAsBitmapFile.
Definition at line 848 of file CRandomFieldGridMap2D.cpp.
References getAsMatrix(), MRPT_END, MRPT_START, and mrpt::img::CImage::setFromMatrix().
Referenced by saveAsBitmapFile().
void mrpt::maps::CRandomFieldGridMap2D::getAsMatlab3DGraphScript | ( | std::string & | out_script | ) | const |
Return a large text block with a MATLAB script to plot the contents of this map.
|
virtual |
Like saveAsBitmapFile(), but returns the data in matrix form (first row in the matrix is the upper (y_max) part of the map)
Like saveAsBitmapFile(), but returns the data in matrix form.
Definition at line 803 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByIndex(), computeMeanCellValue_DM_DMV(), mrpt::maps::TRandomFieldCell::gmrf_mean(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_max, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_min, mrpt::maps::TRandomFieldCell::kf_mean(), m_insertOptions_common, m_mapType, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_y, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, mrKernelDM, mrKernelDMV, MRPT_END, MRPT_START, recoverMeanAndCov(), mrpt::math::CMatrixDynamic< T >::resize(), mrpt::saturate(), and THROW_EXCEPTION.
Referenced by getAsBitmapFile().
|
inlineinherited |
Get the entire grid as a matrix.
MAT | The type of the matrix, typically a mrpt::math::CMatrixDouble. |
[out] | m | The output matrix; will be set automatically to the correct size. Entry (cy,cx) in the matrix contains the grid cell with indices (cx,cy). |
Definition at line 299 of file CDynamicGrid.h.
|
inlinevirtualinherited |
If the map is a simple points map or it's a multi-metric map that contains EXACTLY one simple points map, return it.
Otherwise, return nullptr
Reimplemented in mrpt::maps::CMultiMetricMap, and mrpt::maps::CSimplePointsMap.
Definition at line 295 of file CMetricMap.h.
Referenced by mrpt::maps::CPointsMap::compute3DMatchingRatio(), and mrpt::maps::CMetricMap::getAsSimplePointsMap().
|
inlineinherited |
Definition at line 299 of file CMetricMap.h.
References mrpt::maps::CMetricMap::getAsSimplePointsMap().
|
protectedpure virtual |
Get the part of the options common to all CRandomFieldGridMap2D classes.
Implemented in mrpt::maps::CGasConcentrationGridMap2D, mrpt::maps::CHeightGridMap2D_MRF, and mrpt::maps::CWirelessPowerGridMap2D.
|
inherited |
Fill the provided string with the contents of the logger's history in std::string representation.
Definition at line 154 of file COutputLogger.cpp.
|
inherited |
Get the history of COutputLogger instance in a string representation.
Definition at line 159 of file COutputLogger.cpp.
Referenced by mrpt::graphslam::deciders::CICPCriteriaNRD< GRAPH_T >::getDescriptiveReport().
|
inherited |
Return the last Tmsg instance registered in the logger history.
Definition at line 195 of file COutputLogger.cpp.
References mrpt::system::COutputLogger::TMsg::getAsString().
|
inherited |
Fill inputtted string with the contents of the last message in history.
Definition at line 201 of file COutputLogger.cpp.
|
inherited |
Return the name of the COutputLogger instance.
Definition at line 143 of file COutputLogger.cpp.
CRandomFieldGridMap2D::TMapRepresentation CRandomFieldGridMap2D::getMapType | ( | ) |
Return the type of the random-field grid map, according to parameters passed on construction.
Definition at line 2448 of file CRandomFieldGridMap2D.cpp.
References m_mapType.
void CRandomFieldGridMap2D::getMeanAndCov | ( | mrpt::math::CVectorDouble & | out_means, |
mrpt::math::CMatrixDouble & | out_cov | ||
) | const |
Return the mean and covariance vector of the full Kalman filter estimate (works for all KF-based methods).
Definition at line 2399 of file CRandomFieldGridMap2D.cpp.
References m_cov, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, recoverMeanAndCov(), and mrpt::math::CVectorDynamic< T >::resize().
void CRandomFieldGridMap2D::getMeanAndSTD | ( | mrpt::math::CVectorDouble & | out_means, |
mrpt::math::CVectorDouble & | out_STD | ||
) | const |
Return the mean and STD vectors of the full Kalman filter estimate (works for all KF-based methods).
Definition at line 2414 of file CRandomFieldGridMap2D.cpp.
References mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, m_stackedCov, and mrpt::math::CVectorDynamic< T >::resize().
|
inlineinherited |
Definition at line 201 of file system/COutputLogger.h.
References mrpt::system::COutputLogger::m_min_verbosity_level.
Referenced by mrpt::apps::RawlogGrabberApp::dump_verbose_info(), isEnabledVerbose(), mrpt::slam::CMetricMapBuilderRBPF::processActionObservation(), mrpt::apps::CGridMapAlignerApp::run(), mrpt::apps::RBPF_SLAM_App_Base::run(), and mrpt::apps::ICP_SLAM_App_Base::run().
|
inlineinherited |
Returns the resolution of the grid map.
Definition at line 254 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::build_Gaussian_Wind_Grid(), and mrpt::maps::CGasConcentrationGridMap2D::getWindAs3DObject().
|
overridevirtual |
Returns information about the class of an object in runtime.
Reimplemented from mrpt::maps::CMetricMap.
Reimplemented in mrpt::maps::CHeightGridMap2D_MRF, mrpt::maps::CGasConcentrationGridMap2D, and mrpt::maps::CWirelessPowerGridMap2D.
|
static |
|
inlineinherited |
Returns the horizontal size of grid map in cells count.
Definition at line 242 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection().
|
inlineinherited |
Returns the vertical size of grid map in cells count.
Definition at line 244 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection().
|
inlineinherited |
Returns the "x" coordinate of right side of grid map.
Definition at line 248 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::getWindAs3DObject().
|
inlineinherited |
Returns the "x" coordinate of left side of grid map.
Definition at line 246 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::getWindAs3DObject().
|
inlineinherited |
Returns the "y" coordinate of bottom side of grid map.
Definition at line 252 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::getWindAs3DObject().
|
inlineinherited |
Returns the "y" coordinate of top side of grid map.
Definition at line 250 of file CDynamicGrid.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::getWindAs3DObject().
|
inlineprotectedinherited |
Can be called by a derived class before preparing an event for publishing with publishEvent to determine if there is no one subscribed, so it can save the wasted time preparing an event that will be not read.
Definition at line 53 of file CObservable.h.
References mrpt::system::CObservable::m_subscribers.
Referenced by mrpt::gui::CWindowDialog::OnMouseDown(), mrpt::gui::CWindowDialog::OnMouseMove(), mrpt::gui::CWindowDialog::OnResize(), mrpt::opengl::COpenGLViewport::render(), and mrpt::opengl::COpenGLViewport::renderNormalSceneMode().
|
inlineinherited |
Transform a global (linear) cell index value into its corresponding (x,y) cell indexes.
Definition at line 271 of file CDynamicGrid.h.
Referenced by insertObservation_KF2(), resize(), and mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection().
|
inlineinherited |
Transform a cell index into a coordinate value of the cell central point.
Definition at line 279 of file CDynamicGrid.h.
Referenced by predictMeasurement(), and saveMetricMapRepresentationToFile().
|
inlineinherited |
Definition at line 283 of file CDynamicGrid.h.
Referenced by predictMeasurement(), and saveMetricMapRepresentationToFile().
void CRandomFieldGridMap2D::insertIndividualReading | ( | const double | sensorReading, |
const mrpt::math::TPoint2D & | point, | ||
const bool | update_map = true , |
||
const bool | time_invariant = true , |
||
const double | reading_stddev = .0 |
||
) |
Direct update of the map with a reading in a given position of the map, using the appropriate method according to mapType passed in the constructor.
This is a direct way to update the map, an alternative to the generic insertObservation() method which works with mrpt::obs::CObservation objects.
sensorReading | The value observed in the (x,y) position |
point | The (x,y) location |
update_map | Run a global map update after inserting this observatin (algorithm-dependant) |
time_invariant | Whether the observation "vanishes" with time (false) or not (true) [Only for GMRF methods] |
reading_stddev | The uncertainty (standard deviation) of the reading. Default="0.0" means use the default settings per map-wide parameters. |
Definition at line 2473 of file CRandomFieldGridMap2D.cpp.
References insertObservation_GMRF(), insertObservation_KernelDM_DMV(), insertObservation_KF(), insertObservation_KF2(), m_insertOptions_common, m_mapType, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, mrKernelDM, mrKernelDMV, mrpt::square(), and THROW_EXCEPTION.
Referenced by mrpt::maps::CWirelessPowerGridMap2D::internal_insertObservation(), and mrpt::maps::CGasConcentrationGridMap2D::internal_insertObservation().
|
inherited |
Insert the observation information into this map.
This method must be implemented in derived classes. See: Maps and observations compatibility matrix
obs | The observation |
robotPose | The 3D pose of the robot mobile base in the map reference system, or NULL (default) if you want to use the origin. |
Definition at line 93 of file CMetricMap.cpp.
Referenced by ICPTests::align2scans(), mrpt::maps::COccupancyGridMap2D::computeObservationLikelihood_likelihoodField_Thrun(), mrpt::graphslam::deciders::CRangeScanOps< GRAPH_T >::getICPEdge(), CAngularObservationMesh_fnctr::operator()(), TEST(), and mrpt::graphslam::CGraphSlamEngine< GRAPH_T >::updateMapVisualization().
|
protected |
The implementation of "insertObservation" for the Gaussian Markov Random Field map model.
normReading | Is a [0,1] normalized concentration reading. |
point | Is the sensor location on the map |
Definition at line 2509 of file CRandomFieldGridMap2D.cpp.
References mrpt::graphs::ScalarFactorGraph::addConstraint(), ASSERT_, mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByPos(), mrpt::maps::CRandomFieldGridMap2D::TObservationGMRF::Lambda, m_gmrf, m_mrf_factors_activeObs, mrpt::graphs::ScalarFactorGraph::UnaryFactorVirtualBase::node_id, mrpt::maps::CRandomFieldGridMap2D::TObservationGMRF::obsValue, mrpt::maps::CRandomFieldGridMap2D::TObservationGMRF::time_invariant, updateMapEstimation_GMRF(), mrpt::math::TPoint2D_data< T >::x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::xy2idx(), and mrpt::math::TPoint2D_data< T >::y.
Referenced by insertIndividualReading().
|
protected |
The implementation of "insertObservation" for Achim Lilienthal's map models DM & DM+V.
normReading | Is a [0,1] normalized concentration reading. |
point | Is the sensor location on the map |
is_DMV | = false -> map type is Kernel DM; true -> map type is DM+V |
normReading | Is a [0,1] normalized concentration reading. |
is_DMV | = false -> map type is Kernel DM; true -> map type is DM+V |
Definition at line 584 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::maps::TRandomFieldCell::dm_mean(), mrpt::maps::TRandomFieldCell::dm_mean_w(), mrpt::maps::TRandomFieldCell::dmv_var_mean, MRPT_END, MRPT_LOG_DEBUG, MRPT_LOG_DEBUG_FMT, MRPT_START, resize(), mrpt::round(), mrpt::square(), mrpt::math::TPoint2D_data< T >::x, and mrpt::math::TPoint2D_data< T >::y.
Referenced by insertIndividualReading().
|
protected |
The implementation of "insertObservation" for the (whole) Kalman Filter map model.
normReading | Is a [0,1] normalized concentration reading. |
point | Is the sensor location on the map |
Definition at line 1179 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByPos(), mrpt::math::CMatrixDynamic< T >::cols(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_defaultCellMeanValue, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_initialCellStd, mrpt::maps::TRandomFieldCell::kf_mean(), m_cov, m_insertOptions_common, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, mrpt::system::os::memcpy(), MRPT_END, MRPT_LOG_DEBUG, MRPT_LOG_DEBUG_FMT, MRPT_START, resize(), mrpt::math::CMatrixDynamic< T >::rows(), mrpt::square(), mrpt::system::CTicTac::Tac(), mrpt::system::CTicTac::Tic(), mrpt::math::TPoint2D_data< T >::x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::xy2idx(), and mrpt::math::TPoint2D_data< T >::y.
Referenced by insertIndividualReading().
|
protected |
The implementation of "insertObservation" for the Efficient Kalman Filter map model.
normReading | Is a [0,1] normalized concentration reading. |
point | Is the sensor location on the map |
Definition at line 2170 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByPos(), mrpt::math::CMatrixDynamic< T >::cols(), mrpt::containers::CDynamicGrid< TRandomFieldCell >::idx2cxcy(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_covSigma, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_defaultCellMeanValue, mrpt::maps::TRandomFieldCell::kf_mean(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_observationModelNoise, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_W_size, m_hasToRecoverMeanAndCov, m_insertOptions_common, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_resolution, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_y, m_stackedCov, MRPT_END, MRPT_LOG_DEBUG, MRPT_LOG_DEBUG_FMT, MRPT_LOG_DEBUG_STREAM, MRPT_START, resize(), mrpt::math::CMatrixDynamic< T >::rows(), mrpt::square(), mrpt::system::CTicTac::Tac(), THROW_EXCEPTION_FMT, mrpt::system::CTicTac::Tic(), mrpt::math::TPoint2D_data< T >::x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::x2idx(), mrpt::containers::CDynamicGrid< TRandomFieldCell >::xy2idx(), mrpt::math::TPoint2D_data< T >::y, and mrpt::containers::CDynamicGrid< TRandomFieldCell >::y2idx().
Referenced by insertIndividualReading().
|
inherited |
A wrapper for smart pointers, just calls the non-smart pointer version.
See: Maps and observations compatibility matrix
Definition at line 107 of file CMetricMap.cpp.
References MRPT_END, MRPT_START, and THROW_EXCEPTION.
Referenced by mrpt::slam::CMetricMapBuilderICP::processObservation().
|
overrideprotectedvirtual |
Erase all the contents of the map.
Implements mrpt::maps::CMetricMap.
Reimplemented in mrpt::maps::CWirelessPowerGridMap2D.
Definition at line 83 of file CRandomFieldGridMap2D.cpp.
References mrpt::serialization::archiveFrom(), ASSERT_, dir, mrpt::maps::CSimpleMap::empty(), mrpt::maps::COccupancyGridMap2D::getCell(), mrpt::maps::CRandomFieldGridMap2D::ConnectivityDescriptor::getEdgeInformation(), mrpt::maps::COccupancyGridMap2D::getResolution(), mrpt::maps::COccupancyGridMap2D::getSizeX(), mrpt::maps::COccupancyGridMap2D::getSizeY(), mrpt::maps::COccupancyGridMap2D::getXMax(), mrpt::maps::COccupancyGridMap2D::getXMin(), mrpt::maps::COccupancyGridMap2D::getYMax(), mrpt::maps::COccupancyGridMap2D::getYMin(), mrpt::maps::CRandomFieldGridMap2D::TObservationGMRF::Lambda, mrpt::maps::CRandomFieldGridMap2D::TPriorFactorGMRF::Lambda, mrpt::maps::COccupancyGridMap2D::loadFromBitmapFile(), mrpt::maps::CMetricMap::loadFromSimpleMap(), mrpt::system::os::memcpy(), MRPT_LOG_DEBUG, MRPT_LOG_DEBUG_FMT, MRPT_LOG_DEBUG_STREAM, mrpt::graphs::ScalarFactorGraph::UnaryFactorVirtualBase::node_id, mrpt::graphs::ScalarFactorGraph::BinaryFactorVirtualBase::node_id_i, mrpt::graphs::ScalarFactorGraph::BinaryFactorVirtualBase::node_id_j, mrpt::maps::CRandomFieldGridMap2D::TObservationGMRF::obsValue, resize(), mrpt::maps::COccupancyGridMap2D::saveAsBitmapFile(), mrpt::square(), mrpt::system::CTicTac::Tac(), THROW_EXCEPTION, mrpt::system::CTicTac::Tic(), and mrpt::maps::CRandomFieldGridMap2D::TObservationGMRF::time_invariant.
Referenced by mrpt::maps::CWirelessPowerGridMap2D::internal_clear(), mrpt::maps::CHeightGridMap2D_MRF::internal_clear(), and mrpt::maps::CGasConcentrationGridMap2D::internal_clear().
|
overridevirtual |
Returns true if the map is empty/no observation has been inserted (in this class it always return false, unless redefined otherwise in base classes)
Implements mrpt::maps::CMetricMap.
Definition at line 575 of file CRandomFieldGridMap2D.cpp.
|
inline |
Definition at line 475 of file CRandomFieldGridMap2D.h.
References mrpt::system::COutputLogger::getMinLoggingLevel(), and mrpt::system::LVL_DEBUG.
|
inlineinherited |
Definition at line 202 of file system/COutputLogger.h.
References mrpt::system::COutputLogger::m_min_verbosity_level.
Referenced by mrpt::slam::CMetricMapBuilderRBPF::processActionObservation(), and mrpt::system::COutputLoggerStreamWrapper::~COutputLoggerStreamWrapper().
|
inline |
Definition at line 484 of file CRandomFieldGridMap2D.h.
References mrpt::graphs::ScalarFactorGraph::isProfilerEnabled(), and m_gmrf.
|
inherited |
Load the map contents from a CSimpleMap object, erasing all previous content of the map.
This is done invoking insertObservation()
for each observation at the mean 3D robot pose of each pose-observations pair in the CSimpleMap object.
std::exception | Some internal steps in invoked methods can raise exceptions on invalid parameters, etc... |
Definition at line 36 of file CMetricMap.cpp.
References ASSERTMSG_, mrpt::containers::clear(), mrpt::maps::CSimpleMap::get(), and mrpt::maps::CSimpleMap::size().
Referenced by mrpt::apps::MonteCarloLocalization_Base::do_pf_localization(), mrpt::maps::CMetricMap::loadFromSimpleMap(), mrpt::apps::CGridMapAlignerApp::run(), and run_test_pf_localization().
|
inlineinherited |
!
This is an overloaded member function, provided for convenience. It differs from the above function only in what argument(s) it accepts.
Definition at line 106 of file CMetricMap.h.
References mrpt::maps::CMetricMap::loadFromProbabilisticPosesAndObservations().
Referenced by internal_clear(), and mrpt::ros1bridge::MapHdl::loadMap().
|
inherited |
Log the given message only if the condition is satisfied.
Definition at line 131 of file COutputLogger.cpp.
|
inherited |
Definition at line 291 of file COutputLogger.cpp.
References getAddress(), and mrpt::system::COutputLogger::m_listCallbacks.
|
inherited |
Alternative logging method, which mimics the printf behavior.
Handy for not having to first use mrpt::format to pass a std::string message to logStr
Definition at line 91 of file COutputLogger.cpp.
Referenced by mrpt::hmtslam::CHMTSLAM::areaAbstraction(), mrpt::graphslam::deciders::CICPCriteriaNRD< GRAPH_T >::CICPCriteriaNRD(), mrpt::hmtslam::CTopLCDetector_GridMatching::computeTopologicalObservationModel(), CGraphSlamHandler< GRAPH_T >::execute(), mrpt::math::CLevenbergMarquardtTempl< VECTORTYPE, USERPARAM >::execute(), CGraphSlamHandler< GRAPH_T >::initOutputDir(), CGraphSlamHandler< GRAPH_T >::initVisualization(), mrpt::nav::CNavigatorManualSequence::navigationStep(), mrpt::nav::CAbstractNavigator::performNavigationStepNavigating(), CGraphSlamHandler< GRAPH_T >::readConfigFname(), CGraphSlamHandler< GRAPH_T >::saveResults(), CGraphSlamHandler< GRAPH_T >::setResultsDirName(), mrpt::nav::CReactiveNavigationSystem::STEP1_InitPTGs(), mrpt::hmtslam::CHMTSLAM::thread_3D_viewer(), mrpt::hmtslam::CHMTSLAM::thread_LSLAM(), mrpt::hmtslam::CHMTSLAM::thread_TBI(), and CGraphSlamHandler< GRAPH_T >::~CGraphSlamHandler().
|
inherited |
Reset the contents of the logger instance.
Called upon construction.
Definition at line 206 of file COutputLogger.cpp.
References mrpt::system::LVL_INFO.
|
staticinherited |
Map from VerbosityLevels to their corresponding mrpt::system::TConsoleColor.
Handy for coloring the input based on the verbosity of the message
Definition at line 47 of file COutputLogger.cpp.
References logging_levels_to_colors.
Referenced by mrpt::system::COutputLogger::TMsg::dumpToConsole().
|
staticinherited |
Map from VerbosityLevels to their corresponding names.
Handy for printing the current message VerbosityLevel along with the actual content
Definition at line 60 of file COutputLogger.cpp.
References logging_levels_to_names.
Referenced by mrpt::system::COutputLogger::TMsg::getAsString().
|
inherited |
Definition at line 278 of file COutputLogger.cpp.
References mrpt::system::COutputLogger::m_listCallbacks.
|
inherited |
Main method to add the specified message string to the logger.
Definition at line 72 of file COutputLogger.cpp.
References mrpt::system::COutputLogger::TMsg::body, mrpt::system::COutputLogger::TMsg::dumpToConsole(), mrpt::system::COutputLogger::TMsg::level, mrpt::system::COutputLogger::TMsg::name, and mrpt::system::COutputLogger::TMsg::timestamp.
Referenced by mrpt::slam::PF_implementation< mrpt::math::TPose3D, CMonteCarloLocalization3D, mrpt::bayes::particle_storage_mode::VALUE >::PF_SLAM_implementation_pfAuxiliaryPFStandardAndOptimal(), mrpt::nav::CReactiveNavigationSystem::STEP1_InitPTGs(), mrpt::system::COutputLoggerStreamWrapper::~COutputLoggerStreamWrapper(), and mrpt::system::CTimeLoggerSaveAtDtor::~CTimeLoggerSaveAtDtor().
|
inlineprotectedinherited |
Used only from logically const method that really need to modify the object.
Definition at line 45 of file CDynamicGrid.h.
Referenced by recoverMeanAndCov().
|
virtual |
Returns the prediction of the measurement at some (x,y) coordinates, and its certainty (in the form of the expected variance).
x | Query X coordinate |
y | Query Y coordinate |
out_predict_response | The output value |
out_predict_response_variance | The output variance |
do_sensor_normalization | Whether to renormalize the prediction to a predefined interval (R values in insertionOptions) |
interp_method | Interpolation method |
Definition at line 2021 of file CRandomFieldGridMap2D.cpp.
References mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByIndex(), computeMeanCellValue_DM_DMV(), computeVarCellValue_DM_DMV(), gimBilinear, gimNearest, mrpt::containers::CDynamicGrid< TRandomFieldCell >::idx2x(), mrpt::containers::CDynamicGrid< TRandomFieldCell >::idx2y(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_defaultCellMeanValue, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_initialCellStd, mrpt::maps::TRandomFieldCell::kf_mean(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_observationModelNoise, mrpt::maps::TRandomFieldCell::kf_std(), m_average_normreadings_mean, m_hasToRecoverMeanAndCov, m_insertOptions_common, m_mapType, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_resolution, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_max, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_min, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_min, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, mrKernelDM, mrKernelDMV, MRPT_END, MRPT_START, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::R_max, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::R_min, recoverMeanAndCov(), mrpt::square(), THROW_EXCEPTION, mrpt::containers::CDynamicGrid< TRandomFieldCell >::x2idx(), and mrpt::containers::CDynamicGrid< TRandomFieldCell >::y2idx().
|
protectedinherited |
Called when you want this object to emit an event to all the observers currently subscribed to this object.
Definition at line 57 of file CObservable.cpp.
References MRPT_END, and MRPT_START.
Referenced by mrpt::gui::CDisplayWindow3D::internal_emitGrabImageEvent(), mrpt::gui::CWindowDialog::OnChar(), mrpt::gui::CWindowDialog::OnClose(), mrpt::gui::C3DWindowDialog::OnClose(), mrpt::gui::CWindowDialog::OnMouseDown(), mrpt::gui::CWindowDialog::OnMouseMove(), mrpt::gui::CWindowDialog::OnResize(), mrpt::gui::C3DWindowDialog::OnResize(), mrpt::opengl::COpenGLViewport::render(), and mrpt::opengl::COpenGLViewport::renderNormalSceneMode().
|
protected |
In the KF2 implementation, takes the auxiliary matrices and from them update the cells' mean and std values.
Definition at line 2385 of file CRandomFieldGridMap2D.cpp.
References m_hasToRecoverMeanAndCov, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map_castaway_const(), m_mapType, m_stackedCov, and mrKalmanApproximate.
Referenced by getAs3DObject(), getAsMatrix(), getMeanAndCov(), mrpt::maps::CGasConcentrationGridMap2D::increaseUncertainty(), predictMeasurement(), saveAsMatlab3DGraph(), saveMetricMapRepresentationToFile(), setMeanAndSTD(), and mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection().
|
inlinevirtualinherited |
Changes the size of the grid, maintaining previous contents.
Definition at line 117 of file CDynamicGrid.h.
|
override |
Changes the size of the grid, maintaining previous contents.
Definition at line 861 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::math::CMatrixDynamic< T >::cols(), mrpt::containers::CDynamicGrid< TRandomFieldCell >::idx2cxcy(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_covSigma, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_initialCellStd, mrpt::maps::TRandomFieldCell::kf_std(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::KF_W_size, m_cov, m_insertOptions_common, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, m_mapType, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_resolution, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_y, m_stackedCov, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_min, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_min, mrpt::system::os::memcpy(), mrKalmanApproximate, mrKalmanFilter, MRPT_END, MRPT_END_WITH_CLEAN_UP, MRPT_LOG_DEBUG_FMT, MRPT_START, resize(), mrpt::round(), mrpt::math::CMatrixDynamic< T >::rows(), mrpt::math::CMatrixDynamic< T >::setSize(), and mrpt::square().
Referenced by insertObservation_KF(), and insertObservation_KF2().
|
virtual |
Save the current map as a graphical file (BMP,PNG,...).
The file format will be derived from the file extension (see CImage::saveToFile ) It depends on the map representation model: mrAchim: Each pixel is the ratio mrKalmanFilter: Each pixel is the mean value of the Gaussian that represents each cell.
Definition at line 791 of file CRandomFieldGridMap2D.cpp.
References getAsBitmapFile(), MRPT_END, and MRPT_START.
Referenced by saveMetricMapRepresentationToFile().
|
virtual |
Save a matlab ".m" file which represents as 3D surfaces the mean and a given confidence level for the concentration of each cell.
This method can only be called in a KF map model.
Definition at line 1444 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByIndex(), mrpt::system::os::fclose(), mrpt::system::os::fopen(), mrpt::system::os::fprintf(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_max, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_min, mrpt::maps::TRandomFieldCell::kf_mean(), mrpt::maps::TRandomFieldCell::kf_std(), m_insertOptions_common, m_mapType, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_resolution, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_y, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_max, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_min, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_max, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_min, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, MRPT_END, MRPT_START, recoverMeanAndCov(), mrpt::saturate_val(), and THROW_EXCEPTION.
Referenced by saveMetricMapRepresentationToFile().
|
overridevirtual |
The implementation in this class just calls all the corresponding method of the contained metric maps.
Implements mrpt::maps::CMetricMap.
Definition at line 1299 of file CRandomFieldGridMap2D.cpp.
References mrpt::containers::CDynamicGrid< TRandomFieldCell >::cellByIndex(), computeConfidenceCellValue_DM_DMV(), computeMeanCellValue_DM_DMV(), computeVarCellValue_DM_DMV(), mrpt::maps::TRandomFieldCell::gmrf_mean(), mrpt::maps::TRandomFieldCell::gmrf_std(), mrpt::containers::CDynamicGrid< TRandomFieldCell >::idx2x(), mrpt::containers::CDynamicGrid< TRandomFieldCell >::idx2y(), mrpt::maps::TRandomFieldCell::kf_mean(), mrpt::maps::TRandomFieldCell::kf_std(), m_cov, m_mapType, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_x, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_size_y, m_stackedCov, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_max, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_x_min, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_max, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_y_min, mrpt::math::MATRIX_FORMAT_FIXED, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, mrKernelDM, mrKernelDMV, recoverMeanAndCov(), saveAsBitmapFile(), saveAsMatlab3DGraph(), mrpt::img::CImage::saveToFile(), mrpt::math::MatrixVectorBase< Scalar, Derived >::saveToTextFile(), mrpt::img::CImage::setFromMatrix(), and THROW_EXCEPTION.
|
inlineinherited |
Saves a float representation of the grid (via "cell2float()") to a text file.
Definition at line 313 of file CDynamicGrid.h.
|
protectedpure virtualinherited |
Pure virtual method for reading (deserializing) from an abstract archive.
Users don't call this method directly. Instead, use stream >> object;
.
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 I/O error |
Implemented in mrpt::obs::CObservation3DRangeScan, mrpt::nav::CLogFileRecord_ND, mrpt::nav::CLogFileRecord_FullEval, mrpt::img::CImage, mrpt::maps::CMultiMetricMap, mrpt::obs::CObservationIMU, mrpt::poses::CPose3D, mrpt::obs::CObservationRGBD360, mrpt::obs::CObservationVelodyneScan, mrpt::maps::TMapGenericParams, mrpt::maps::CRandomFieldGridMap3D, mrpt::hmtslam::THypothesisIDSet, mrpt::detectors::CDetectable3D, mrpt::maps::CLandmarksMap, mrpt::hmtslam::CHMTSLAM, mrpt::hmtslam::CLocalMetricHypothesis, mrpt::opengl::COctoMapVoxels, mrpt::kinematics::CKinematicChain, mrpt::obs::CObservationGPS, mrpt::maps::CMultiMetricMapPDF, mrpt::maps::CHeightGridMap2D, mrpt::obs::CRawlog, mrpt::opengl::COpenGLViewport, mrpt::obs::CObservationRotatingScan, mrpt::opengl::CPlanarLaserScan, mrpt::nav::CHolonomicFullEval, mrpt::opengl::COpenGLScene, mrpt::slam::CIncrementalMapPartitioner, mrpt::vision::CFeature, mrpt::maps::COccupancyGridMap2D, mrpt::obs::CObservation2DRangeScan, mrpt::opengl::CFrustum, mrpt::nav::CHolonomicND, mrpt::obs::CSensoryFrame, mrpt::poses::CPose2DInterpolator, mrpt::opengl::CEllipsoidInverseDepth3D, mrpt::poses::CPose3DInterpolator, mrpt::nav::CHolonomicVFF, mrpt::opengl::CPointCloud, mrpt::opengl::CPointCloudColoured, mrpt::poses::CPose3DQuat, mrpt::opengl::CPolyhedron, mrpt::hmtslam::CLSLAMParticleData, mrpt::opengl::CEllipsoidInverseDepth2D, mrpt::detectors::CDetectable2D, mrpt::maps::CBeaconMap, mrpt::opengl::CAngularObservationMesh, mrpt::opengl::CAssimpModel, mrpt::poses::CPose3DQuatPDFGaussian, mrpt::poses::CPose3DQuatPDFGaussianInf, mrpt::opengl::CEllipsoidRangeBearing2D, mrpt::opengl::CText3D, mrpt::maps::COctoMap, mrpt::opengl::CBox, mrpt::opengl::CEllipsoid2D, mrpt::poses::CPose2D, mrpt::maps::CReflectivityGridMap2D, mrpt::nav::CPTG_DiffDrive_C, mrpt::opengl::CEllipsoid3D, mrpt::poses::CPose3DPDFGaussianInf, mrpt::opengl::CVectorField3D, mrpt::poses::CPose3DPDFGaussian, mrpt::maps::CColouredOctoMap, mrpt::obs::CObservationStereoImages, mrpt::opengl::CMesh, mrpt::opengl::CMeshFast, mrpt::poses::CPosePDFParticles, mrpt::hmtslam::CHMHMapNode, mrpt::hmtslam::CRobotPosesGraph, mrpt::opengl::CMesh3D, mrpt::opengl::CVectorField2D, mrpt::poses::CPose3DPDFParticles, mrpt::hmtslam::CMHPropertiesValuesList, mrpt::obs::CObservationStereoImagesFeatures, mrpt::opengl::CColorBar, mrpt::maps::CBeacon, mrpt::maps::COccupancyGridMap3D, mrpt::nav::CPTG_DiffDrive_alpha, mrpt::opengl::CText, mrpt::maps::CRBPFParticleData, mrpt::maps::CLandmark, mrpt::maps::CHeightGridMap2D_MRF, mrpt::opengl::CCamera, mrpt::poses::CPosePDFGaussianInf, mrpt::poses::CPosePDFSOG, mrpt::hmtslam::CHMHMapArc, mrpt::obs::CObservationPointCloud, mrpt::opengl::CSetOfLines, mrpt::poses::CPoint2D, mrpt::poses::CPointPDFSOG, mrpt::maps::CGasConcentrationGridMap2D, mrpt::maps::CWirelessPowerGridMap2D, mrpt::maps::CSimpleMap, mrpt::obs::CObservationImage, mrpt::poses::CPoint3D, mrpt::poses::CPose3DPDFSOG, mrpt::obs::CObservationBatteryState, mrpt::hmtslam::CHierarchicalMHMap, mrpt::maps::CSimplePointsMap, mrpt::obs::CActionRobotMovement2D, mrpt::opengl::CDisk, mrpt::maps::CColouredPointsMap, mrpt::maps::CWeightedPointsMap, mrpt::nav::CLogFileRecord, mrpt::obs::CObservationOdometry, mrpt::obs::CObservationRawDAQ, mrpt::opengl::CAxis, mrpt::opengl::CCylinder, mrpt::opengl::CGridPlaneXY, mrpt::opengl::CGridPlaneXZ, mrpt::opengl::CSphere, mrpt::poses::CPointPDFParticles, mrpt::obs::CObservationBearingRange, mrpt::obs::CObservationWindSensor, mrpt::opengl::CArrow, mrpt::poses::CPosePDFGaussian, mrpt::obs::CObservationRange, mrpt::img::TCamera, mrpt::maps::CPointsMapXYZI, mrpt::nav::CPTG_Holo_Blend, mrpt::obs::CActionCollection, mrpt::obs::CActionRobotMovement3D, mrpt::obs::CObservationWirelessPower, mrpt::opengl::CSetOfObjects, mrpt::nav::CLogFileRecord_VFF, mrpt::nav::CPTG_DiffDrive_CC, mrpt::nav::CPTG_DiffDrive_CCS, mrpt::nav::CPTG_DiffDrive_CS, mrpt::obs::CObservation6DFeatures, mrpt::obs::CObservationSkeleton, mrpt::poses::CPose3DPDFGrid, mrpt::obs::CObservationVisualLandmarks, mrpt::math::CMatrixD, mrpt::math::CSplineInterpolator1D, mrpt::obs::CObservationBeaconRanges, mrpt::obs::CObservationComment, mrpt::obs::CObservationGasSensors, mrpt::obs::CObservationReflectivity, mrpt::obs::CObservationRFID, mrpt::poses::CPosePDFGrid, mrpt::poses::CPoses2DSequence, mrpt::img::TStereoCamera, mrpt::poses::CPoses3DSequence, mrpt::math::CMatrixF, mrpt::opengl::CSetOfTriangles, mrpt::poses::CPointPDFGaussian, mrpt::hmtslam::CPropertiesValuesList, mrpt::math::CMatrixB, mrpt::obs::CObservationCANBusJ1939, mrpt::obs::CObservationRobotPose, mrpt::opengl::CSetOfTexturedTriangles, mrpt::math::CPolygon, mrpt::opengl::CTexturedPlane, mrpt::poses::CPoint2DPDFGaussian, mrpt::kinematics::CVehicleVelCmd_DiffDriven, mrpt::kinematics::CVehicleVelCmd_Holo, mrpt::opengl::CSimpleLine, and MyNS::Foo.
Referenced by mrpt::serialization::CArchive::internal_ReadObject(), and mrpt::serialization::CSchemeArchiveBase::WriteObject().
|
inlineprotectedvirtualinherited |
Virtual method for reading (deserializing) from an abstract schema based archive.
Definition at line 74 of file CSerializable.h.
References mrpt::serialization::CSerializable::GetRuntimeClass(), and THROW_EXCEPTION.
|
protectedpure virtualinherited |
Must return the current versioning number of the object.
Start in zero for new classes, and increments each time there is a change in the stored format.
Implemented in mrpt::obs::CObservation3DRangeScan, mrpt::nav::CLogFileRecord_ND, mrpt::nav::CLogFileRecord_FullEval, mrpt::img::CImage, mrpt::maps::CMultiMetricMap, mrpt::obs::CObservationIMU, mrpt::poses::CPose3D, mrpt::obs::CObservationRGBD360, mrpt::obs::CObservationVelodyneScan, mrpt::maps::TMapGenericParams, mrpt::maps::CRandomFieldGridMap3D, mrpt::hmtslam::THypothesisIDSet, mrpt::detectors::CDetectable3D, mrpt::maps::CLandmarksMap, mrpt::hmtslam::CHMTSLAM, mrpt::hmtslam::CLocalMetricHypothesis, mrpt::opengl::COctoMapVoxels, mrpt::kinematics::CKinematicChain, mrpt::obs::CObservationGPS, mrpt::maps::CMultiMetricMapPDF, mrpt::maps::CHeightGridMap2D, mrpt::obs::CRawlog, mrpt::opengl::COpenGLViewport, mrpt::obs::CObservationRotatingScan, mrpt::opengl::CPlanarLaserScan, mrpt::nav::CHolonomicFullEval, mrpt::opengl::COpenGLScene, mrpt::slam::CIncrementalMapPartitioner, mrpt::vision::CFeature, mrpt::maps::COccupancyGridMap2D, mrpt::obs::CObservation2DRangeScan, mrpt::opengl::CFrustum, mrpt::nav::CHolonomicND, mrpt::obs::CSensoryFrame, mrpt::poses::CPose2DInterpolator, mrpt::opengl::CEllipsoidInverseDepth3D, mrpt::poses::CPose3DInterpolator, mrpt::nav::CHolonomicVFF, mrpt::opengl::CPointCloud, mrpt::opengl::CPointCloudColoured, mrpt::poses::CPose3DQuat, mrpt::opengl::CPolyhedron, mrpt::hmtslam::CLSLAMParticleData, mrpt::opengl::CEllipsoidInverseDepth2D, mrpt::detectors::CDetectable2D, mrpt::maps::CBeaconMap, mrpt::opengl::CAngularObservationMesh, mrpt::opengl::CAssimpModel, mrpt::poses::CPose3DQuatPDFGaussian, mrpt::poses::CPose3DQuatPDFGaussianInf, mrpt::opengl::CEllipsoidRangeBearing2D, mrpt::opengl::CText3D, mrpt::maps::COctoMap, mrpt::opengl::CBox, mrpt::opengl::CEllipsoid2D, mrpt::poses::CPose2D, mrpt::maps::CReflectivityGridMap2D, mrpt::nav::CPTG_DiffDrive_C, mrpt::opengl::CEllipsoid3D, mrpt::poses::CPose3DPDFGaussianInf, mrpt::opengl::CVectorField3D, mrpt::poses::CPose3DPDFGaussian, mrpt::maps::CColouredOctoMap, mrpt::obs::CObservationStereoImages, mrpt::opengl::CMesh, mrpt::opengl::CMeshFast, mrpt::poses::CPosePDFParticles, mrpt::hmtslam::CHMHMapNode, mrpt::hmtslam::CRobotPosesGraph, mrpt::opengl::CMesh3D, mrpt::opengl::CVectorField2D, mrpt::poses::CPose3DPDFParticles, mrpt::hmtslam::CMHPropertiesValuesList, mrpt::obs::CObservationStereoImagesFeatures, mrpt::opengl::CColorBar, mrpt::maps::CBeacon, mrpt::maps::COccupancyGridMap3D, mrpt::nav::CPTG_DiffDrive_alpha, mrpt::opengl::CText, mrpt::maps::CRBPFParticleData, mrpt::maps::CLandmark, mrpt::maps::CHeightGridMap2D_MRF, mrpt::opengl::CCamera, mrpt::poses::CPosePDFGaussianInf, mrpt::poses::CPosePDFSOG, mrpt::hmtslam::CHMHMapArc, mrpt::obs::CObservationPointCloud, mrpt::opengl::CSetOfLines, mrpt::poses::CPoint2D, mrpt::poses::CPointPDFSOG, mrpt::maps::CGasConcentrationGridMap2D, mrpt::maps::CWirelessPowerGridMap2D, mrpt::maps::CSimpleMap, mrpt::obs::CObservationImage, mrpt::poses::CPoint3D, mrpt::poses::CPose3DPDFSOG, mrpt::obs::CObservationBatteryState, mrpt::hmtslam::CHierarchicalMHMap, mrpt::maps::CSimplePointsMap, mrpt::obs::CActionRobotMovement2D, mrpt::opengl::CDisk, mrpt::maps::CColouredPointsMap, mrpt::maps::CWeightedPointsMap, mrpt::nav::CLogFileRecord, mrpt::obs::CObservationOdometry, mrpt::obs::CObservationRawDAQ, mrpt::opengl::CAxis, mrpt::opengl::CCylinder, mrpt::opengl::CGridPlaneXY, mrpt::opengl::CGridPlaneXZ, mrpt::opengl::CSphere, mrpt::poses::CPointPDFParticles, mrpt::obs::CObservationBearingRange, mrpt::obs::CObservationWindSensor, mrpt::opengl::CArrow, mrpt::poses::CPosePDFGaussian, mrpt::obs::CObservationRange, mrpt::img::TCamera, mrpt::maps::CPointsMapXYZI, mrpt::nav::CPTG_Holo_Blend, mrpt::obs::CActionCollection, mrpt::obs::CActionRobotMovement3D, mrpt::obs::CObservationWirelessPower, mrpt::opengl::CSetOfObjects, mrpt::nav::CLogFileRecord_VFF, mrpt::nav::CPTG_DiffDrive_CC, mrpt::nav::CPTG_DiffDrive_CCS, mrpt::nav::CPTG_DiffDrive_CS, mrpt::obs::CObservation6DFeatures, mrpt::obs::CObservationSkeleton, mrpt::poses::CPose3DPDFGrid, mrpt::obs::CObservationVisualLandmarks, mrpt::math::CMatrixD, mrpt::math::CSplineInterpolator1D, mrpt::obs::CObservationBeaconRanges, mrpt::obs::CObservationComment, mrpt::obs::CObservationGasSensors, mrpt::obs::CObservationReflectivity, mrpt::obs::CObservationRFID, mrpt::poses::CPosePDFGrid, mrpt::poses::CPoses2DSequence, mrpt::img::TStereoCamera, mrpt::poses::CPoses3DSequence, mrpt::math::CMatrixF, mrpt::opengl::CSetOfTriangles, mrpt::poses::CPointPDFGaussian, mrpt::hmtslam::CPropertiesValuesList, mrpt::math::CMatrixB, mrpt::obs::CObservationCANBusJ1939, mrpt::obs::CObservationRobotPose, mrpt::opengl::CSetOfTexturedTriangles, mrpt::math::CPolygon, mrpt::opengl::CTexturedPlane, mrpt::poses::CPoint2DPDFGaussian, mrpt::kinematics::CVehicleVelCmd_DiffDriven, mrpt::kinematics::CVehicleVelCmd_Holo, mrpt::opengl::CSimpleLine, and MyNS::Foo.
Referenced by mrpt::serialization::CArchive::WriteObject().
|
protectedpure virtualinherited |
Pure virtual method for writing (serializing) to an abstract archive.
Users don't call this method directly. Instead, use stream << object;
.
std::exception | On any I/O error |
Implemented in mrpt::obs::CObservation3DRangeScan, mrpt::nav::CLogFileRecord_ND, mrpt::nav::CLogFileRecord_FullEval, mrpt::img::CImage, mrpt::maps::CMultiMetricMap, mrpt::obs::CObservationIMU, mrpt::poses::CPose3D, mrpt::obs::CObservationRGBD360, mrpt::obs::CObservationVelodyneScan, mrpt::maps::TMapGenericParams, mrpt::maps::CRandomFieldGridMap3D, mrpt::hmtslam::THypothesisIDSet, mrpt::detectors::CDetectable3D, mrpt::maps::CLandmarksMap, mrpt::hmtslam::CHMTSLAM, mrpt::hmtslam::CLocalMetricHypothesis, mrpt::opengl::COctoMapVoxels, mrpt::kinematics::CKinematicChain, mrpt::obs::CObservationGPS, mrpt::maps::CMultiMetricMapPDF, mrpt::maps::CHeightGridMap2D, mrpt::obs::CRawlog, mrpt::opengl::COpenGLViewport, mrpt::obs::CObservationRotatingScan, mrpt::opengl::CPlanarLaserScan, mrpt::nav::CHolonomicFullEval, mrpt::opengl::COpenGLScene, mrpt::slam::CIncrementalMapPartitioner, mrpt::vision::CFeature, mrpt::maps::COccupancyGridMap2D, mrpt::obs::CObservation2DRangeScan, mrpt::opengl::CFrustum, mrpt::nav::CHolonomicND, mrpt::obs::CSensoryFrame, mrpt::poses::CPose2DInterpolator, mrpt::opengl::CEllipsoidInverseDepth3D, mrpt::poses::CPose3DInterpolator, mrpt::nav::CHolonomicVFF, mrpt::opengl::CPointCloud, mrpt::opengl::CPointCloudColoured, mrpt::poses::CPose3DQuat, mrpt::opengl::CPolyhedron, mrpt::hmtslam::CLSLAMParticleData, mrpt::opengl::CEllipsoidInverseDepth2D, mrpt::detectors::CDetectable2D, mrpt::maps::CBeaconMap, mrpt::opengl::CAngularObservationMesh, mrpt::opengl::CAssimpModel, mrpt::poses::CPose3DQuatPDFGaussian, mrpt::poses::CPose3DQuatPDFGaussianInf, mrpt::opengl::CEllipsoidRangeBearing2D, mrpt::opengl::CText3D, mrpt::maps::COctoMap, mrpt::opengl::CBox, mrpt::opengl::CEllipsoid2D, mrpt::poses::CPose2D, mrpt::maps::CReflectivityGridMap2D, mrpt::nav::CPTG_DiffDrive_C, mrpt::opengl::CEllipsoid3D, mrpt::poses::CPose3DPDFGaussianInf, mrpt::opengl::CVectorField3D, mrpt::poses::CPose3DPDFGaussian, mrpt::maps::CColouredOctoMap, mrpt::obs::CObservationStereoImages, mrpt::opengl::CMesh, mrpt::opengl::CMeshFast, mrpt::poses::CPosePDFParticles, mrpt::hmtslam::CHMHMapNode, mrpt::hmtslam::CRobotPosesGraph, mrpt::opengl::CMesh3D, mrpt::opengl::CVectorField2D, mrpt::poses::CPose3DPDFParticles, mrpt::hmtslam::CMHPropertiesValuesList, mrpt::obs::CObservationStereoImagesFeatures, mrpt::opengl::CColorBar, mrpt::maps::CBeacon, mrpt::maps::COccupancyGridMap3D, mrpt::nav::CPTG_DiffDrive_alpha, mrpt::opengl::CText, mrpt::maps::CRBPFParticleData, mrpt::maps::CLandmark, mrpt::maps::CHeightGridMap2D_MRF, mrpt::opengl::CCamera, mrpt::poses::CPosePDFGaussianInf, mrpt::poses::CPosePDFSOG, mrpt::hmtslam::CHMHMapArc, mrpt::obs::CObservationPointCloud, mrpt::opengl::CSetOfLines, mrpt::poses::CPoint2D, mrpt::poses::CPointPDFSOG, mrpt::maps::CGasConcentrationGridMap2D, mrpt::maps::CWirelessPowerGridMap2D, mrpt::maps::CSimpleMap, mrpt::obs::CObservationImage, mrpt::poses::CPoint3D, mrpt::poses::CPose3DPDFSOG, mrpt::obs::CObservationBatteryState, mrpt::hmtslam::CHierarchicalMHMap, mrpt::maps::CSimplePointsMap, mrpt::obs::CActionRobotMovement2D, mrpt::opengl::CDisk, mrpt::maps::CColouredPointsMap, mrpt::maps::CWeightedPointsMap, mrpt::nav::CLogFileRecord, mrpt::obs::CObservationOdometry, mrpt::obs::CObservationRawDAQ, mrpt::opengl::CAxis, mrpt::opengl::CCylinder, mrpt::opengl::CGridPlaneXY, mrpt::opengl::CGridPlaneXZ, mrpt::opengl::CSphere, mrpt::poses::CPointPDFParticles, mrpt::obs::CObservationBearingRange, mrpt::obs::CObservationWindSensor, mrpt::opengl::CArrow, mrpt::poses::CPosePDFGaussian, mrpt::obs::CObservationRange, mrpt::img::TCamera, mrpt::maps::CPointsMapXYZI, mrpt::nav::CPTG_Holo_Blend, mrpt::obs::CActionCollection, mrpt::obs::CActionRobotMovement3D, mrpt::obs::CObservationWirelessPower, mrpt::opengl::CSetOfObjects, mrpt::nav::CLogFileRecord_VFF, mrpt::nav::CPTG_DiffDrive_CC, mrpt::nav::CPTG_DiffDrive_CCS, mrpt::nav::CPTG_DiffDrive_CS, mrpt::obs::CObservation6DFeatures, mrpt::obs::CObservationSkeleton, mrpt::poses::CPose3DPDFGrid, mrpt::obs::CObservationVisualLandmarks, mrpt::math::CMatrixD, mrpt::math::CSplineInterpolator1D, mrpt::obs::CObservationBeaconRanges, mrpt::obs::CObservationComment, mrpt::obs::CObservationGasSensors, mrpt::obs::CObservationReflectivity, mrpt::obs::CObservationRFID, mrpt::poses::CPosePDFGrid, mrpt::poses::CPoses2DSequence, mrpt::img::TStereoCamera, mrpt::poses::CPoses3DSequence, mrpt::math::CMatrixF, mrpt::opengl::CSetOfTriangles, mrpt::poses::CPointPDFGaussian, mrpt::hmtslam::CPropertiesValuesList, mrpt::math::CMatrixB, mrpt::obs::CObservationCANBusJ1939, mrpt::obs::CObservationRobotPose, mrpt::opengl::CSetOfTexturedTriangles, mrpt::math::CPolygon, mrpt::opengl::CTexturedPlane, mrpt::poses::CPoint2DPDFGaussian, mrpt::kinematics::CVehicleVelCmd_DiffDriven, mrpt::kinematics::CVehicleVelCmd_Holo, mrpt::opengl::CSimpleLine, and MyNS::Foo.
Referenced by mrpt::serialization::CSchemeArchiveBase::ReadObject(), and mrpt::serialization::CArchive::WriteObject().
|
inlineprotectedvirtualinherited |
Virtual method for writing (serializing) to an abstract schema based archive.
Definition at line 64 of file CSerializable.h.
References mrpt::serialization::CSerializable::GetRuntimeClass(), and THROW_EXCEPTION.
void CRandomFieldGridMap2D::setCellsConnectivity | ( | const ConnectivityDescriptor::Ptr & | new_connectivity_descriptor | ) |
Sets a custom object to define the connectivity between cells.
Must call clear() or setSize() afterwards for the changes to take place.
Definition at line 74 of file CRandomFieldGridMap2D.cpp.
|
inherited |
Set the name of the COutputLogger instance.
Definition at line 138 of file COutputLogger.cpp.
Referenced by mrpt::slam::CMetricMapBuilderICP::CMetricMapBuilderICP(), mrpt::slam::CMetricMapBuilderRBPF::CMetricMapBuilderRBPF(), mrpt::slam::CMonteCarloLocalization2D::CMonteCarloLocalization2D(), mrpt::slam::CMonteCarloLocalization3D::CMonteCarloLocalization3D(), mrpt::apps::ICP_SLAM_App_Base::ICP_SLAM_App_Base(), mrpt::apps::ICP_SLAM_App_Live::ICP_SLAM_App_Live(), mrpt::apps::ICP_SLAM_App_Rawlog::ICP_SLAM_App_Rawlog(), mrpt::graphslam::CWindowManager::initCWindowManager(), mrpt::apps::MonteCarloLocalization_Base::MonteCarloLocalization_Base(), mrpt::apps::RBPF_SLAM_App_Base::RBPF_SLAM_App_Base(), and mrpt::apps::RBPF_SLAM_App_Rawlog::RBPF_SLAM_App_Rawlog().
void CRandomFieldGridMap2D::setMeanAndSTD | ( | mrpt::math::CVectorDouble & | out_means, |
mrpt::math::CVectorDouble & | out_STD | ||
) |
Load the mean and STD vectors of the full Kalman filter estimate (works for all KF-based methods).
Definition at line 2431 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, m_hasToRecoverMeanAndCov, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, m_stackedCov, recoverMeanAndCov(), mrpt::math::CVectorDynamic< T >::size(), and mrpt::square().
|
inherited |
Set the minimum logging level for which the incoming logs are going to be taken into account.
String messages with specified VerbosityLevel smaller than the min, will not be outputted to the screen and neither will a record of them be stored in by the COutputLogger instance
Definition at line 144 of file COutputLogger.cpp.
Referenced by enableVerbose(), mrpt::math::CLevenbergMarquardtTempl< VECTORTYPE, USERPARAM >::execute(), generic_kf_slam_test(), generic_pf_test(), generic_rbpf_slam_test(), mrpt::apps::RawlogGrabberApp::initialize(), mrpt::hwdrivers::CHokuyoURG::initialize(), mrpt::graphslam::deciders::CICPCriteriaNRD< GRAPH_T >::loadParams(), mrpt::apps::CGridMapAlignerApp::run(), mrpt::apps::RBPF_SLAM_App_Base::run(), and mrpt::apps::ICP_SLAM_App_Base::run().
|
inlineinherited |
Changes the size of the grid, ERASING all previous contents.
If fill_value is left as nullptr, the contents of cells may be undefined (some will remain with their old values, the new ones will have the default cell value, but the location of old values may change wrt their old places). If fill_value is not nullptr, it is assured that all cells will have a copy of that value after resizing.
Definition at line 74 of file CDynamicGrid.h.
Referenced by setSize().
|
virtual |
Changes the size of the grid, erasing previous contents.
[in] | connectivity_descriptor | Optional user-supplied object that will visit all grid cells to define their connectivity with neighbors and the strength of existing edges. If present, it overrides all options in insertionOptions |
Definition at line 64 of file CRandomFieldGridMap2D.cpp.
References mrpt::maps::CMetricMap::clear(), and mrpt::containers::CDynamicGrid< TRandomFieldCell >::setSize().
|
inherited |
alias of setMinLoggingLevel()
Definition at line 149 of file COutputLogger.cpp.
Referenced by mrpt::nav::CAbstractNavigator::CAbstractNavigator(), mrpt::slam::CMetricMapBuilderRBPF::CMetricMapBuilderRBPF(), mrpt::comms::CServerTCPSocket::CServerTCPSocket(), mrpt::slam::CMetricMapBuilderRBPF::processActionObservation(), mrpt::math::ransac_detect_2D_lines(), and mrpt::apps::ICP_SLAM_App_Base::run().
|
virtualinherited |
Returns the square distance from the 2D point (x0,y0) to the closest correspondence in the map.
Reimplemented in mrpt::maps::CPointsMap.
Definition at line 153 of file CMetricMap.cpp.
References MRPT_END, MRPT_START, and THROW_EXCEPTION.
void CRandomFieldGridMap2D::updateMapEstimation | ( | ) |
Run the method-specific procedure required to ensure that the mean & variances are up-to-date with all inserted observations.
Definition at line 2453 of file CRandomFieldGridMap2D.cpp.
References m_mapType, mrGMRF_SD, mrKalmanApproximate, mrKalmanFilter, mrKernelDM, mrKernelDMV, THROW_EXCEPTION, and updateMapEstimation_GMRF().
|
protected |
solves the minimum quadratic system to determine the new concentration of each cell
Definition at line 2545 of file CRandomFieldGridMap2D.cpp.
References ASSERT_, mrpt::graphs::ScalarFactorGraph::eraseConstraint(), mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_lambdaObsLoss, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_max, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_saturate_min, mrpt::maps::CRandomFieldGridMap2D::TInsertionOptionsCommon::GMRF_skip_variance, m_gmrf, m_insertOptions_common, mrpt::containers::CDynamicGrid< TRandomFieldCell >::m_map, m_mrf_factors_activeObs, mrpt::saturate(), mrpt::math::CVectorDynamic< T >::size(), and mrpt::graphs::ScalarFactorGraph::updateEstimation().
Referenced by insertObservation_GMRF(), and updateMapEstimation().
|
inherited |
Write the contents of the COutputLogger instance to an external file.
Upon call to this method, COutputLogger dumps the contents of all the logged commands so far to the specified external file. By default the filename is set to ${LOGGERNAME}.log except if the fname parameter is provided
Definition at line 165 of file COutputLogger.cpp.
References ASSERTMSG_, and mrpt::format().
|
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 nullptr is class does not support conversion to MATLAB. Definition at line 90 of file CSerializable.h.
|
inlineinherited |
Transform a coordinate values into cell indexes.
Definition at line 256 of file CDynamicGrid.h.
Referenced by insertObservation_KF2(), and predictMeasurement().
|
inlineinherited |
Definition at line 264 of file CDynamicGrid.h.
Referenced by insertObservation_GMRF(), insertObservation_KF(), and insertObservation_KF2().
|
inlineinherited |
Definition at line 260 of file CDynamicGrid.h.
Referenced by insertObservation_KF2(), and predictMeasurement().
|
inherited |
Common params to all maps.
Definition at line 274 of file CMetricMap.h.
Referenced by mrpt::maps::internal::TMetricMapTypesRegistry::factoryMapObjectFromDefinition(), mrpt::maps::CWirelessPowerGridMap2D::getAs3DObject(), mrpt::maps::CGasConcentrationGridMap2D::getAs3DObject(), mrpt::maps::CReflectivityGridMap2D::getAs3DObject(), mrpt::maps::CHeightGridMap2D::getAs3DObject(), getAs3DObject(), mrpt::maps::CLandmarksMap::getAs3DObject(), mrpt::maps::CPointsMap::getAs3DObject(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CReflectivityGridMap2D::serializeFrom(), mrpt::maps::CHeightGridMap2D::serializeFrom(), mrpt::maps::CWirelessPowerGridMap2D::serializeTo(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), mrpt::maps::CReflectivityGridMap2D::serializeTo(), and mrpt::maps::CHeightGridMap2D::serializeTo().
|
inherited |
[Default=true] Set it to false in case you don't want the logged messages to be dumped to the output automatically.
Definition at line 240 of file system/COutputLogger.h.
|
inherited |
[Default=false] Enables storing all messages into an internal list.
Definition at line 243 of file system/COutputLogger.h.
|
protected |
Definition at line 521 of file CRandomFieldGridMap2D.h.
Referenced by mrpt::maps::CWirelessPowerGridMap2D::internal_insertObservation(), mrpt::maps::CGasConcentrationGridMap2D::internal_insertObservation(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), and mrpt::maps::CWirelessPowerGridMap2D::serializeTo().
|
protected |
Definition at line 520 of file CRandomFieldGridMap2D.h.
Referenced by computeMeanCellValue_DM_DMV(), mrpt::maps::CWirelessPowerGridMap2D::internal_insertObservation(), mrpt::maps::CGasConcentrationGridMap2D::internal_insertObservation(), predictMeasurement(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), and mrpt::maps::CWirelessPowerGridMap2D::serializeTo().
|
protected |
Definition at line 520 of file CRandomFieldGridMap2D.h.
Referenced by computeVarCellValue_DM_DMV(), mrpt::maps::CWirelessPowerGridMap2D::internal_insertObservation(), mrpt::maps::CGasConcentrationGridMap2D::internal_insertObservation(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), and mrpt::maps::CWirelessPowerGridMap2D::serializeTo().
|
protected |
The whole covariance matrix, used for the Kalman Filter map representation.
Definition at line 504 of file CRandomFieldGridMap2D.h.
Referenced by getMeanAndCov(), insertObservation_KF(), resize(), saveMetricMapRepresentationToFile(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), and mrpt::maps::CWirelessPowerGridMap2D::serializeTo().
|
protected |
Definition at line 519 of file CRandomFieldGridMap2D.h.
|
protected |
Definition at line 518 of file CRandomFieldGridMap2D.h.
|
protected |
Definition at line 527 of file CRandomFieldGridMap2D.h.
Referenced by enableProfiler(), insertObservation_GMRF(), isProfilerEnabled(), and updateMapEstimation_GMRF().
|
protected |
Empty: default.
Definition at line 525 of file CRandomFieldGridMap2D.h.
|
mutableprotected |
Only for the KF2 implementation.
Definition at line 514 of file CRandomFieldGridMap2D.h.
Referenced by mrpt::maps::CGasConcentrationGridMap2D::increaseUncertainty(), insertObservation_KF2(), predictMeasurement(), recoverMeanAndCov(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), setMeanAndSTD(), and mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection().
|
protected |
Common options to all random-field grid maps: pointer that is set to the derived-class instance of "insertOptions" upon construction of this class.
Definition at line 492 of file CRandomFieldGridMap2D.h.
Referenced by computeConfidenceCellValue_DM_DMV(), computeMeanCellValue_DM_DMV(), computeVarCellValue_DM_DMV(), getAs3DObject(), getAsMatrix(), insertIndividualReading(), insertObservation_KF(), insertObservation_KF2(), predictMeasurement(), resize(), saveAsMatlab3DGraph(), and updateMapEstimation_GMRF().
|
protectedinherited |
The cells.
Definition at line 42 of file CDynamicGrid.h.
Referenced by getMeanAndCov(), getMeanAndSTD(), mrpt::maps::CGasConcentrationGridMap2D::getWindAs3DObject(), mrpt::maps::CGasConcentrationGridMap2D::increaseUncertainty(), insertObservation_KF(), insertObservation_KF2(), recoverMeanAndCov(), resize(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), mrpt::maps::CWirelessPowerGridMap2D::serializeTo(), setMeanAndSTD(), mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection(), and updateMapEstimation_GMRF().
|
protected |
The map representation type of this map, as passed in the constructor.
Definition at line 500 of file CRandomFieldGridMap2D.h.
Referenced by getAs3DObject(), getAsMatrix(), getMapType(), insertIndividualReading(), predictMeasurement(), recoverMeanAndCov(), resize(), saveAsMatlab3DGraph(), saveMetricMapRepresentationToFile(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CWirelessPowerGridMap2D::serializeTo(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), and updateMapEstimation().
|
protectedinherited |
Provided messages with VerbosityLevel smaller than this value shall be ignored.
Definition at line 253 of file system/COutputLogger.h.
Referenced by mrpt::system::COutputLogger::getMinLoggingLevel(), and mrpt::system::COutputLogger::isLoggingLevelVisible().
|
protected |
Vector with the active observations and their respective Information.
Definition at line 575 of file CRandomFieldGridMap2D.h.
Referenced by insertObservation_GMRF(), and updateMapEstimation_GMRF().
|
protected |
Vector with the precomputed priors for each GMRF model.
Definition at line 577 of file CRandomFieldGridMap2D.h.
|
protectedinherited |
Definition at line 50 of file CDynamicGrid.h.
Referenced by getAs3DObject(), insertObservation_KF2(), predictMeasurement(), resize(), and saveAsMatlab3DGraph().
|
protected |
Definition at line 487 of file CRandomFieldGridMap2D.h.
|
protectedinherited |
Definition at line 51 of file CDynamicGrid.h.
Referenced by getAs3DObject(), getAsMatrix(), insertObservation_KF2(), resize(), saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
protectedinherited |
Definition at line 51 of file CDynamicGrid.h.
Referenced by getAs3DObject(), getAsMatrix(), insertObservation_KF2(), resize(), saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
protected |
The compressed band diagonal matrix for the KF2 implementation.
The format is a Nx(W^2+2W+1) matrix, one row per cell in the grid map with the cross-covariances between each cell and half of the window around it in the grid.
Definition at line 512 of file CRandomFieldGridMap2D.h.
Referenced by getMeanAndSTD(), mrpt::maps::CGasConcentrationGridMap2D::increaseUncertainty(), insertObservation_KF2(), recoverMeanAndCov(), resize(), saveMetricMapRepresentationToFile(), mrpt::maps::CWirelessPowerGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeFrom(), mrpt::maps::CGasConcentrationGridMap2D::serializeTo(), mrpt::maps::CWirelessPowerGridMap2D::serializeTo(), setMeanAndSTD(), and mrpt::maps::CGasConcentrationGridMap2D::simulateAdvection().
|
protectedinherited |
Definition at line 50 of file CDynamicGrid.h.
Referenced by predictMeasurement(), saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
protectedinherited |
Definition at line 50 of file CDynamicGrid.h.
Referenced by getAs3DObject(), predictMeasurement(), resize(), saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
protectedinherited |
Definition at line 50 of file CDynamicGrid.h.
Referenced by saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
protectedinherited |
Definition at line 50 of file CDynamicGrid.h.
Referenced by getAs3DObject(), predictMeasurement(), resize(), saveAsMatlab3DGraph(), and saveMetricMapRepresentationToFile().
|
staticprotected |
Definition at line 159 of file CRandomFieldGridMap2D.h.
Page generated by Doxygen 1.8.14 for MRPT 2.0.4 Git: 33de1d0ad Sat Jun 20 11:02:42 2020 +0200 at sáb jun 20 17:35:17 CEST 2020 |