MRPT
1.9.9
|
The most high level class for storing hybrid, multi-hypothesis maps in a graph-based model.
This class is used within the HMT-SLAM implementation in CHMTSLAM.
Definition at line 26 of file CHierarchicalMHMap.h.
#include <mrpt/hmtslam/CHierarchicalMHMap.h>
Public Types | |
using | iterator = TNodeList::iterator |
using | const_iterator = TNodeList::const_iterator |
using | TNodeIDsList = std::vector< CHMHMapNode::TNodeID > |
A type that reprensents a sequence of node IDs. More... | |
Public Member Functions | |
CHierarchicalMHMap () | |
Default constructor. More... | |
void | dumpAsXMLfile (std::string fileName) const |
Destructor. More... | |
void | loadFromXMLfile (std::string fileName) |
Load a graph from a XML file. More... | |
~CHierarchicalMHMap () override | |
void | clear () |
Erase all the contents of map (It delete all nodes/arcs objects) More... | |
virtual mxArray * | writeToMatlab () const |
Introduces a pure virtual method responsible for writing to a mxArray Matlab object, typically a MATLAB struct whose contents are documented in each derived class. More... | |
const_iterator | begin () const |
Returns an iterator to the first node in the graph. More... | |
iterator | begin () |
Returns an iterator to the first node in the graph. More... | |
const_iterator | end () const |
Returns an iterator to the end of the list of nodes in the graph. More... | |
iterator | end () |
Returns an iterator to the end of the list of nodes in the graph. More... | |
size_t | nodeCount () const |
Returns the number of nodes in the partition: More... | |
size_t | arcCount () const |
Returns the number of arcs in the partition: More... | |
CHMHMapNode::Ptr | getFirstNode () |
Returns the first node in the graph, or nullptr if it does not exist. More... | |
CHMHMapNode::Ptr | getNodeByID (CHMHMapNode::TNodeID id) |
Returns the node with the given ID, or nullptr if it does not exist. More... | |
const CHMHMapNode::Ptr | getNodeByID (CHMHMapNode::TNodeID id) const |
Returns the node with the given ID, or nullptr if it does not exist. More... | |
CHMHMapNode::Ptr | getNodeByLabel (const std::string &label, const THypothesisID &hypothesisID) |
Returns the node with the given label (case insensitive) for some given hypothesis ID, or nullptr if it does not exist. More... | |
const CHMHMapNode::Ptr | getNodeByLabel (const std::string &label, const THypothesisID &hypothesisID) const |
Returns the node with the given label (case insensitive) for some given hypothesis ID, or nullptr if it does not exist. More... | |
void | saveAreasDiagramForMATLAB (const std::string &filName, const CHMHMapNode::TNodeID &idReferenceNode, const THypothesisID &hypothesisID) const |
Returns a partition of this graph only with nodes at a given level in the hierarchy (0=ground level,1=parent level,etc) More... | |
void | saveAreasDiagramWithEllipsedForMATLAB (const std::string &filName, const CHMHMapNode::TNodeID &idReferenceNode, const THypothesisID &hypothesisID, float uncertaintyExagerationFactor=1.0f, bool drawArcs=false, unsigned int numberOfIterationsForOptimalGlobalPoses=4) const |
Saves a MATLAB script that represents graphically the nodes with type="Area" in this hierarchical-map(partition), using the stated node as global coordinates reference, and drawing the ellipses of the localization uncertainty for each node. More... | |
void | saveGlobalMapForMATLAB (const std::string &filName, const THypothesisID &hypothesisID, const CHMHMapNode::TNodeID &idReferenceNode) const |
Saves a MATLAB script that represents graphically the reconstructed "global map" ADDITIONAL NOTES: More... | |
void | findPathBetweenNodes (const CHMHMapNode::TNodeID &nodeFrom, const CHMHMapNode::TNodeID &nodeTo, const THypothesisID &hypothesisID, TArcList &out_path, bool direction=false) const |
The Dijkstra algorithm for finding the shortest path between a pair of nodes. More... | |
void | computeCoordinatesTransformationBetweenNodes (const CHMHMapNode::TNodeID &nodeFrom, const CHMHMapNode::TNodeID &nodeTo, mrpt::poses::CPose3DPDFParticles &posePDF, const THypothesisID &hypothesisID, unsigned int particlesCount=100, float additionalNoiseXYratio=0.02, float additionalNoisePhiRad=mrpt::DEG2RAD(0.1)) const |
Draw a number of samples according to the PDF of the coordinates transformation between a pair of "Area"'s nodes. More... | |
float | computeMatchProbabilityBetweenNodes (const CHMHMapNode::TNodeID &nodeFrom, const CHMHMapNode::TNodeID &nodeTo, float &maxMatchProb, mrpt::poses::CPose3DPDFSOG &estimatedRelativePose, const THypothesisID &hypothesisID, unsigned int monteCarloSamplesPose=300) |
Computes the probability [0,1] of two areas' gridmaps to "match" (loop closure), according to the grid maps and pose uncertainty from information in arcs (uses a Monte Carlo aproximation) If there is not enough information or a robust estimation cannot be found, there will not be particles in "estimatedRelativePose". More... | |
void | findArcsBetweenNodes (const CHMHMapNode::TNodeID &node1, const CHMHMapNode::TNodeID &node2, const THypothesisID &hypothesisID, TArcList &out_listArcs) const |
Returns all the arcs between a pair of nodes: More... | |
void | findArcsOfTypeBetweenNodes (const CHMHMapNode::TNodeID &node1id, const CHMHMapNode::TNodeID &node2id, const THypothesisID &hypothesisID, const std::string &arcType, TArcList &ret) const |
Returns the arcs between a pair of nodes of a given type. More... | |
CHMHMapArc::Ptr | findArcOfTypeBetweenNodes (const CHMHMapNode::TNodeID &node1id, const CHMHMapNode::TNodeID &node2id, const THypothesisID &hypothesisID, const std::string &arcType, bool &isInverted) const |
Returns the first arc between a pair of nodes of a given type, and if it is in the opposite direction. More... | |
bool | areNodesNeightbour (const CHMHMapNode::TNodeID &node1, const CHMHMapNode::TNodeID &node2, const THypothesisID &hypothesisID, const char *requiredAnnotation=nullptr) const |
Returns whether two nodes are "neightbour", i.e. More... | |
void | computeGloballyConsistentNodeCoordinates (std::map< CHMHMapNode::TNodeID, mrpt::poses::CPose3DPDFGaussian > &nodePoses, const CHMHMapNode::TNodeID &idReferenceNode, const THypothesisID &hypothesisID, const unsigned int &numberOfIterations=2) const |
This methods implements a Lu&Milios-like globally optimal estimation for the global coordinates of all the nodes in the graph according to all available arcs with relative pose information. More... | |
void | getAs3DScene (mrpt::opengl::COpenGLScene &outScene, const CHMHMapNode::TNodeID &idReferenceNode, const THypothesisID &hypothesisID, const unsigned int &numberOfIterationsForOptimalGlobalPoses=5, const bool &showRobotPoseIDs=true) const |
Returns a 3D scene reconstruction of the hierarchical map. More... | |
void | dumpAsText (std::vector< std::string > &s) const |
Return a textual description of the whole graph. More... | |
double | computeOverlapProbabilityBetweenNodes (const CHMHMapNode::TNodeID &nodeFrom, const CHMHMapNode::TNodeID &nodeTo, const THypothesisID &hypothesisID, const size_t &monteCarloSamples=100, const float margin_to_substract=6) const |
Computes the probability [0,1] of two areas' gridmaps to overlap, via a Monte Carlo aproximation. 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... | |
Protected Member Functions | |
void | onNodeAddition (CHMHMapNode::Ptr &node) |
Event handler to be called just after a node has being created: it will be added to the internal list. More... | |
void | onArcAddition (CHMHMapArc::Ptr &arc) |
Event handler to be called just after an arc has being created: it will be added to the internal list. More... | |
void | onNodeDestruction (CHMHMapNode *node) |
Event handler to be called just before a node is being destroyed: it will be removed from the internal list. More... | |
void | onArcDestruction (CHMHMapArc *arc) |
Event handler to be called just before an arc is being destroyed: it will be removed from the internal list. More... | |
CSerializable virtual methods | |
uint8_t | serializeGetVersion () const override |
Must return the current versioning number of the object. More... | |
void | serializeTo (mrpt::serialization::CArchive &out) const override |
Pure virtual method for writing (serializing) to an abstract archive. More... | |
void | serializeFrom (mrpt::serialization::CArchive &in, uint8_t serial_version) override |
Pure virtual method for reading (deserializing) from an abstract archive. More... | |
CSerializable virtual methods | |
virtual void | serializeTo (CSchemeArchiveBase &out) const |
Virtual method for writing (serializing) to an abstract schema based archive. More... | |
virtual void | serializeFrom (CSchemeArchiveBase &in) |
Virtual method for reading (deserializing) from an abstract schema based archive. More... | |
Protected Attributes | |
TNodeList | m_nodes |
The internal list of nodes and arcs in the whole hierarchical model. More... | |
TArcList | m_arcs |
VerbosityLevel | m_min_verbosity_level {LVL_INFO} |
Provided messages with VerbosityLevel smaller than this value shall be ignored. More... | |
Friends | |
class | CHMHMapArc |
class | CHMHMapNode |
RTTI stuff | |
using | Ptr = std::shared_ptr< CHierarchicalMHMap > |
using | ConstPtr = std::shared_ptr< const CHierarchicalMHMap > |
using | UniquePtr = std::unique_ptr< CHierarchicalMHMap > |
using | ConstUniquePtr = std::unique_ptr< const CHierarchicalMHMap > |
static mrpt::rtti::CLASSINIT | _init_CHierarchicalMHMap |
static const mrpt::rtti::TRuntimeClassId | runtimeClassId |
static constexpr const char * | className = "CHierarchicalMHMap" |
static const mrpt::rtti::TRuntimeClassId * | _GetBaseClass () |
static constexpr auto | getClassName () |
static const mrpt::rtti::TRuntimeClassId & | GetRuntimeClassIdStatic () |
static std::shared_ptr< CObject > | CreateObject () |
template<typename... Args> | |
static Ptr | Create (Args &&... args) |
template<typename Alloc , typename... Args> | |
static Ptr | CreateAlloc (const Alloc &alloc, Args &&... args) |
template<typename... Args> | |
static UniquePtr | CreateUnique (Args &&... args) |
virtual const mrpt::rtti::TRuntimeClassId * | GetRuntimeClass () const override |
Returns information about the class of an object in runtime. More... | |
virtual mrpt::rtti::CObject * | clone () const override |
Returns a deep copy (clone) of the object, indepently of its class. More... | |
Logging methods | |
void | logStr (const VerbosityLevel level, const std::string &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... | |
|
inherited |
Definition at line 48 of file CHierarchicalMapMHPartition.h.
Definition at line 32 of file CHierarchicalMHMap.h.
using mrpt::hmtslam::CHierarchicalMHMap::ConstUniquePtr = std::unique_ptr<const CHierarchicalMHMap > |
Definition at line 32 of file CHierarchicalMHMap.h.
|
inherited |
Definition at line 47 of file CHierarchicalMapMHPartition.h.
A type for the associated smart pointer
Definition at line 32 of file CHierarchicalMHMap.h.
|
inherited |
A type that reprensents a sequence of node IDs.
Definition at line 61 of file CHierarchicalMapMHPartition.h.
using mrpt::hmtslam::CHierarchicalMHMap::UniquePtr = std::unique_ptr< CHierarchicalMHMap > |
Definition at line 32 of file CHierarchicalMHMap.h.
|
default |
Default constructor.
|
override |
Definition at line 33 of file CHierarchicalMHMap.cpp.
References mrpt::containers::clear().
|
staticprotected |
|
inherited |
Returns the number of arcs in the partition:
Definition at line 45 of file CHierarchicalMapMHPartition.cpp.
|
inherited |
Returns whether two nodes are "neightbour", i.e.
have a direct arc between them
Definition at line 1070 of file CHierarchicalMapMHPartition.cpp.
References MRPT_END, and MRPT_START.
|
inlineinherited |
Returns an iterator to the first node in the graph.
Definition at line 51 of file CHierarchicalMapMHPartition.h.
References mrpt::hmtslam::CHierarchicalMapMHPartition::m_nodes.
|
inlineinherited |
Returns an iterator to the first node in the graph.
Definition at line 53 of file CHierarchicalMapMHPartition.h.
References mrpt::hmtslam::CHierarchicalMapMHPartition::m_nodes.
void CHierarchicalMHMap::clear | ( | ) |
Erase all the contents of map (It delete all nodes/arcs objects)
Definition at line 37 of file CHierarchicalMHMap.cpp.
|
overridevirtual |
Returns a deep copy (clone) of the object, indepently of its class.
Implements mrpt::rtti::CObject.
|
inherited |
Draw a number of samples according to the PDF of the coordinates transformation between a pair of "Area"'s nodes.
std::exception | If there is not enought information in arcs to compute the PDF |
Definition at line 863 of file CHierarchicalMapMHPartition.cpp.
References ARC_ANNOTATION_DELTA, ARC_ANNOTATION_DELTA_SRC_POSEID, ARC_ANNOTATION_DELTA_TRG_POSEID, ASSERT_, mrpt::poses::CPose3DPDFGaussian::copyFrom(), mrpt::poses::CPose3DPDFGaussian::drawManySamples(), mrpt::random::getRandomGenerator(), mrpt::bayes::CParticleFilterData< T, STORAGE >::m_particles, MRPT_END, MRPT_START, NODE_ANNOTATION_REF_POSEID, mrpt::bayes::CParticleFilterDataImpl< Derived, particle_list_t >::normalizeWeights(), and mrpt::poses::CPose3DPDFParticles::resetDeterministic().
|
inherited |
This methods implements a Lu&Milios-like globally optimal estimation for the global coordinates of all the nodes in the graph according to all available arcs with relative pose information.
Global coordinates will be computed relative to the node "idReferenceNode".
std::exception | If there is any node without a pose arc, invalid (non invertible) matrixes, etc... |
Definition at line 1309 of file CHierarchicalMapMHPartition.cpp.
References ARC_ANNOTATION_DELTA, mrpt::poses::CPose3DPDFGaussianInf::copyFrom(), mrpt::poses::CPose3DPDFGaussian::cov, mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::dijkstra_nodes_estimate(), mrpt::graphs::CDirectedGraph< TYPE_EDGES, EDGE_ANNOTATIONS >::insertEdgeAtEnd(), mrpt::poses::CPose3DPDFGaussian::mean, MRPT_END, MRPT_START, mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::nodes, mrpt::graphslam::optimize_graph_spa_levmarq(), mrpt::graphs::CNetworkOfPoses< CPOSE, MAPS_IMPLEMENTATION, NODE_ANNOTATIONS, EDGE_ANNOTATIONS >::root, and mrpt::math::MatrixBase< Scalar, Derived >::setIdentity().
|
inherited |
Computes the probability [0,1] of two areas' gridmaps to "match" (loop closure), according to the grid maps and pose uncertainty from information in arcs (uses a Monte Carlo aproximation) If there is not enough information or a robust estimation cannot be found, there will not be particles in "estimatedRelativePose".
Definition at line 992 of file CHierarchicalMapMHPartition.cpp.
References MRPT_END, MRPT_START, MRPT_UNUSED_PARAM, and THROW_EXCEPTION.
|
inherited |
Computes the probability [0,1] of two areas' gridmaps to overlap, via a Monte Carlo aproximation.
std::exception | If there is not enought information in arcs, etc... |
margin_to_substract | In meters, the area of each gridmap is "eroded" this amount to compensate the area in excess usually found in gridmaps. |
Definition at line 1555 of file CHierarchicalMapMHPartition.cpp.
References ASSERT_, mrpt::bayes::CParticleFilterData< T, STORAGE >::m_particles, MRPT_END, MRPT_START, NODE_ANNOTATION_METRIC_MAPS, and mrpt::math::RectanglesIntersection().
|
inlinestatic |
Definition at line 32 of file CHierarchicalMHMap.h.
|
inlinestatic |
Definition at line 32 of file CHierarchicalMHMap.h.
|
static |
|
inlinestatic |
Definition at line 32 of file CHierarchicalMHMap.h.
|
inherited |
Return a textual description of the whole graph.
Definition at line 1384 of file CHierarchicalMapMHPartition.cpp.
References ARC_ANNOTATION_DELTA, ARC_ANNOTATION_DELTA_SRC_POSEID, ARC_ANNOTATION_DELTA_TRG_POSEID, ASSERT_, mrpt::poses::CPose3DPDFGaussian::copyFrom(), mrpt::poses::CPose3DPDFParticles::getMean(), mrpt::poses::CPose3DPDFGaussian::mean, NODE_ANNOTATION_POSES_GRAPH, NODE_ANNOTATION_REF_POSEID, mrpt::poses::CPose3D::pitch(), RAD2DEG, mrpt::poses::CPose3D::roll(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS, DIM >::x(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS, DIM >::y(), and mrpt::poses::CPose3D::yaw().
void CHierarchicalMHMap::dumpAsXMLfile | ( | std::string | fileName | ) | const |
Destructor.
Save the whole graph as a XML file
Definition at line 263 of file CHierarchicalMHMap.cpp.
References ASSERT_, mrpt::db::CSimpleDatabase::createTable(), mrpt::format(), IS_CLASS, mrpt::system::os::memcpy(), mrpt::serialization::ObjectToOctetVector(), and mrpt::db::CSimpleDatabase::saveAsXML().
|
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 200 of file CObject.h.
References mrpt::rtti::CObject::clone().
Referenced by mrpt::obs::CRawlog::addActions(), and mrpt::obs::CRawlog::addObservations().
|
inlineinherited |
Returns an iterator to the end of the list of nodes in the graph.
Definition at line 55 of file CHierarchicalMapMHPartition.h.
References mrpt::hmtslam::CHierarchicalMapMHPartition::m_nodes.
|
inlineinherited |
Returns an iterator to the end of the list of nodes in the graph.
Definition at line 57 of file CHierarchicalMapMHPartition.h.
References mrpt::hmtslam::CHierarchicalMapMHPartition::m_nodes.
|
inherited |
Returns the first arc between a pair of nodes of a given type, and if it is in the opposite direction.
Definition at line 1521 of file CHierarchicalMapMHPartition.cpp.
References MRPT_END, and MRPT_START.
|
inherited |
Returns all the arcs between a pair of nodes:
Definition at line 1011 of file CHierarchicalMapMHPartition.cpp.
References MRPT_END, and MRPT_START.
|
inherited |
Returns the arcs between a pair of nodes of a given type.
Definition at line 1040 of file CHierarchicalMapMHPartition.cpp.
References MRPT_END, and MRPT_START.
|
inherited |
The Dijkstra algorithm for finding the shortest path between a pair of nodes.
Definition at line 734 of file CHierarchicalMapMHPartition.cpp.
References ASSERT_, ASSERTMSG_, MRPT_END, and MRPT_START.
|
inherited |
Returns a 3D scene reconstruction of the hierarchical map.
See "computeGloballyConsistentNodeCoordinates" for the meaning of "numberOfIterationsForOptimalGlobalPoses"
Definition at line 1105 of file CHierarchicalMapMHPartition.cpp.
References mrpt::poses::CPose3D::addComponents(), mrpt::opengl::COpenGLScene::clear(), mrpt::opengl::CSimpleLine::Create(), mrpt::opengl::CSetOfObjects::Create(), mrpt::opengl::CSphere::Create(), mrpt::opengl::CGridPlaneXY::Create(), mrpt::opengl::CDisk::Create(), mrpt::opengl::CText::Create(), mrpt::opengl::COpenGLScene::insert(), MRPT_END, MRPT_START, NODE_ANNOTATION_METRIC_MAPS, NODE_ANNOTATION_POSES_GRAPH, mrpt::poses::CPose3D::normalizeAngles(), mrpt::poses::CPoseOrPoint< DERIVEDCLASS, DIM >::x(), and mrpt::poses::CPoseOrPoint< DERIVEDCLASS, DIM >::y().
|
inlinestatic |
Definition at line 32 of file CHierarchicalMHMap.h.
|
inherited |
Returns the first node in the graph, or nullptr if it does not exist.
Definition at line 117 of file CHierarchicalMapMHPartition.cpp.
|
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.
|
inlineinherited |
Definition at line 200 of file system/COutputLogger.h.
References mrpt::system::COutputLogger::m_min_verbosity_level.
Referenced by mrpt::maps::CRandomFieldGridMap2D::isEnabledVerbose(), and mrpt::slam::CMetricMapBuilderRBPF::processActionObservation().
|
inherited |
Returns the node with the given ID, or nullptr if it does not exist.
Definition at line 49 of file CHierarchicalMapMHPartition.cpp.
References AREAID_INVALID, MRPT_END, and MRPT_START.
|
inherited |
Returns the node with the given ID, or nullptr if it does not exist.
Definition at line 63 of file CHierarchicalMapMHPartition.cpp.
References AREAID_INVALID, MRPT_END, and MRPT_START.
|
inherited |
Returns the node with the given label (case insensitive) for some given hypothesis ID, or nullptr if it does not exist.
Definition at line 78 of file CHierarchicalMapMHPartition.cpp.
References mrpt::system::os::_strcmpi(), MRPT_END, and MRPT_START.
|
inherited |
Returns the node with the given label (case insensitive) for some given hypothesis ID, or nullptr if it does not exist.
Definition at line 97 of file CHierarchicalMapMHPartition.cpp.
References mrpt::system::os::_strcmpi(), MRPT_END, and MRPT_START.
|
overridevirtual |
Returns information about the class of an object in runtime.
Reimplemented from mrpt::serialization::CSerializable.
|
static |
|
inlineinherited |
Definition at line 201 of file system/COutputLogger.h.
References mrpt::system::COutputLogger::m_min_verbosity_level.
Referenced by mrpt::slam::CMetricMapBuilderRBPF::processActionObservation(), and mrpt::system::COutputLoggerStreamWrapper::~COutputLoggerStreamWrapper().
void CHierarchicalMHMap::loadFromXMLfile | ( | std::string | fileName | ) |
Load a graph from a XML file.
Definition at line 157 of file CHierarchicalMHMap.cpp.
References COMMON_TOPOLOG_HYP, mrpt::db::CSimpleDatabase::getTable(), mrpt::db::CSimpleDatabase::loadFromXML(), NODE_ANNOTATION_PLACE_POSE, and mrpt::system::tokenize().
|
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::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(), 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().
|
inherited |
Returns the number of nodes in the partition:
Definition at line 41 of file CHierarchicalMapMHPartition.cpp.
|
protected |
Event handler to be called just after an arc has being created: it will be added to the internal list.
Definition at line 145 of file CHierarchicalMHMap.cpp.
|
protected |
Event handler to be called just before an arc is being destroyed: it will be removed from the internal list.
Definition at line 113 of file CHierarchicalMHMap.cpp.
|
protected |
Event handler to be called just after a node has being created: it will be added to the internal list.
Definition at line 124 of file CHierarchicalMHMap.cpp.
References ASSERT_.
|
protected |
Event handler to be called just before a node is being destroyed: it will be removed from the internal list.
Definition at line 100 of file CHierarchicalMHMap.cpp.
References mrpt::hmtslam::CHMHMapNode::getID().
|
inherited |
Returns a partition of this graph only with nodes at a given level in the hierarchy (0=ground level,1=parent level,etc)
Definition at line 128 of file CHierarchicalMapMHPartition.cpp.
References MRPT_UNUSED_PARAM.
|
inherited |
Saves a MATLAB script that represents graphically the nodes with type="Area" in this hierarchical-map(partition), using the stated node as global coordinates reference, and drawing the ellipses of the localization uncertainty for each node.
ADDITIONAL NOTES:
Definition at line 307 of file CHierarchicalMapMHPartition.cpp.
References MRPT_UNUSED_PARAM.
|
inherited |
Saves a MATLAB script that represents graphically the reconstructed "global map" ADDITIONAL NOTES:
Definition at line 486 of file CHierarchicalMapMHPartition.cpp.
References MRPT_END, MRPT_START, and MRPT_UNUSED_PARAM.
|
overrideprotectedvirtual |
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 |
Implements mrpt::serialization::CSerializable.
Definition at line 57 of file CHierarchicalMHMap.cpp.
References mrpt::containers::clear(), and MRPT_THROW_UNKNOWN_SERIALIZATION_VERSION.
|
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.
|
overrideprotectedvirtual |
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.
Implements mrpt::serialization::CSerializable.
Definition at line 45 of file CHierarchicalMHMap.cpp.
|
overrideprotectedvirtual |
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 |
Implements mrpt::serialization::CSerializable.
Definition at line 46 of file CHierarchicalMHMap.cpp.
References mrpt::serialization::CArchive::WriteAs().
|
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.
|
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(), and mrpt::graphslam::CWindowManager::initCWindowManager().
|
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 mrpt::maps::CRandomFieldGridMap2D::enableVerbose(), mrpt::math::CLevenbergMarquardtTempl< VECTORTYPE, USERPARAM >::execute(), mrpt::hwdrivers::CHokuyoURG::initialize(), and mrpt::graphslam::deciders::CICPCriteriaNRD< GRAPH_T >::loadParams().
|
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(), and mrpt::math::ransac_detect_2D_lines().
|
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.
|
friend |
Definition at line 29 of file CHierarchicalMHMap.h.
|
friend |
Definition at line 30 of file CHierarchicalMHMap.h.
|
staticprotected |
Definition at line 32 of file CHierarchicalMHMap.h.
|
static |
Definition at line 32 of file CHierarchicalMHMap.h.
|
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 239 of file system/COutputLogger.h.
|
inherited |
[Default=false] Enables storing all messages into an internal list.
Definition at line 242 of file system/COutputLogger.h.
|
protectedinherited |
Definition at line 44 of file CHierarchicalMapMHPartition.h.
|
protectedinherited |
Provided messages with VerbosityLevel smaller than this value shall be ignored.
Definition at line 252 of file system/COutputLogger.h.
Referenced by mrpt::system::COutputLogger::getMinLoggingLevel(), and mrpt::system::COutputLogger::isLoggingLevelVisible().
|
protectedinherited |
The internal list of nodes and arcs in the whole hierarchical model.
The objects must be deleted only in the CHierarchicalMap class, not in partitions only objects.
Definition at line 43 of file CHierarchicalMapMHPartition.h.
Referenced by mrpt::hmtslam::CHierarchicalMapMHPartition::begin(), and mrpt::hmtslam::CHierarchicalMapMHPartition::end().
|
staticprotected |
Definition at line 32 of file CHierarchicalMHMap.h.
Page generated by Doxygen 1.8.14 for MRPT 1.9.9 Git: 8fe78517f Sun Jul 14 19:43:28 2019 +0200 at lun oct 28 02:10:00 CET 2019 |