template class mrpt::graphslam::deciders::CICPCriteriaERD
ICP-based Edge Registration.
Register new edges in the graph with the last inserted node. Criterion for adding new edges should be the goodness of the candidate ICP edge. The nodes for ICP are picked based on the distance from the last inserted node.
Map type: 2D
MRPT rawlog format: #1, #2
Graph Type: CPosePDFGaussianInf
Observations: CObservation2DRangeScan, CObservation3DRangeScan
Edge Registration Strategy: ICP Goodnesss threshold
class_verbosity
Section : EdgeRegistrationDeciderParameters
default value : 1 (mrpt::system::LVL_INFO)
Required : FALSE
LC_min_nodeid_diff
Section : GeneralConfiguration
Default value : 30
Required : FALSE
Description : Minimum NodeID difference for an edge to be considered a loop closure.
ICP_max_distance
Section : EdgeRegistrationDeciderParameters
Default value : 10 // meters
Required : FALSE
Description : Maximum distance for scan-matching. Decider tries to align the laser scans of the current node and each of the previous nodes that are found within the designated ICP_max_distance.
ICP_goodness_thresh
Section : EdgeRegistrationDeciderParameters
Default value : 0.75
Required : FALSE
Description : Threshold for accepting a scan-matching edge between the current and previous nodes
visualize_laser_scans
Section : VisualizationParameters
Default value : TRUE
Required : FALSE
scans_img_external_dir
Section : EdgeRegistrationDeciderParameters
Default value : . (current directory)
Required : FALSE
Description : Only applicable in datasets with 3DRangeScans that are externally stored (not stored in the given .rawlog file).
See also:
getNearbyNodesOf
#include <mrpt/graphslam/ERD/CICPCriteriaERD.h> template <class GRAPH_T = typename mrpt::graphs::CNetworkOfPoses2DInf> class CICPCriteriaERD: public mrpt::graphslam::deciders::CRangeScanEdgeRegistrationDecider { public: // typedefs typedef typename GRAPH_T::constraint_t constraint_t; typedef typename GRAPH_T::constraint_t::type_value pose_t; typedef CRangeScanEdgeRegistrationDecider<GRAPH_T> parent_t; typedef typename parent_t::range_ops_t range_ops_t; typedef CICPCriteriaERD<GRAPH_T> decider_t; typedef typename parent_t::nodes_to_scans2D_t nodes_to_scans2D_t; // structs struct TParams; // fields TParams params; // construction CICPCriteriaERD(); // methods virtual bool updateState(mrpt::obs::CActionCollection::Ptr action, mrpt::obs::CSensoryFrame::Ptr observations, mrpt::obs::CObservation::Ptr observation); virtual void notifyOfWindowEvents(const std::map<std::string, bool>& events_occurred); virtual void getEdgesStats(std::map<std::string, int>* edge_type_to_num) const; virtual void initializeVisuals(); virtual void updateVisuals(); virtual void loadParams(const std::string& source_fname); virtual void printParams() const; virtual void getDescriptiveReport(std::string* report_str) const; };
Inherited Members
public: // typedefs typedef mrpt::graphslam::CRegistrationDeciderOrOptimizer<GRAPH_T> parent; typedef typename GRAPH_T::constraint_t constraint_t; typedef typename GRAPH_T::constraint_t::type_value pose_t; typedef mrpt::graphslam::deciders::CEdgeRegistrationDecider<GRAPH_T> parent_t; typedef mrpt::graphslam::deciders::CRangeScanOps<GRAPH_T> range_ops_t; typedef std::map<mrpt::graphs::TNodeID, mrpt::obs::CObservation2DRangeScan::Ptr> nodes_to_scans2D_t; // structs struct TMsg; struct TParams; // methods virtual void setClassName(const std::string& name); bool isMultiRobotSlamClass(); std::string getClassName() const; virtual void getEdgesStats(std::map<std::string, int>* edge_type_to_num) const; virtual bool justInsertedLoopClosure() const; virtual void getDescriptiveReport(std::string* report_str) const; virtual bool updateState(mrpt::obs::CActionCollection::Ptr action, mrpt::obs::CSensoryFrame::Ptr observations, mrpt::obs::CObservation::Ptr observation) = 0; virtual void setWindowManagerPtr(mrpt::graphslam::CWindowManager* win_manager); virtual void setCriticalSectionPtr(std::mutex* graph_section); virtual void initializeVisuals(); virtual void updateVisuals(); virtual void notifyOfWindowEvents(const std::map<std::string, bool>& events_occurred); virtual void loadParams(const std::string& source_fname); virtual void printParams() const; virtual void setGraphPtr(GRAPH_T* graph); virtual void initializeLoggers(const std::string& name);
Typedefs
typedef typename GRAPH_T::constraint_t constraint_t
Handy typedefs.
type of graph constraints
typedef typename GRAPH_T::constraint_t::type_value pose_t
type of underlying poses (2D/3D).
typedef CICPCriteriaERD<GRAPH_T> decider_t
self type - Handy type
Methods
virtual bool updateState(mrpt::obs::CActionCollection::Ptr action, mrpt::obs::CSensoryFrame::Ptr observations, mrpt::obs::CObservation::Ptr observation)
Generic method for fetching the incremental action-observations (or observation-only) measurements.
Returns:
True if operation was successful. Criteria for Success depend on the decider/optimizer implementing this method
virtual void notifyOfWindowEvents(const std::map<std::string, bool>& events_occurred)
Get a list of the window events that happened since the last call.
Method in derived classes is automatically called from the CGraphSlamEngine_t instance. After that, decider/optimizer should just fetch the parameters that it is interested in.
virtual void getEdgesStats(std::map<std::string, int>* edge_type_to_num) const
Fill the given map with the type of registered edges as well as the corresponding number of registration of each edge.
virtual void initializeVisuals()
Initialize visual objects in CDisplayWindow (e.g.
add an object to scene).
Parameters:
std::exception |
If the method is called without having first provided a CDisplayWindow3D* to the class instance |
See also:
setWindowManagerPtr, updateVisuals
virtual void updateVisuals()
Update the relevant visual features in CDisplayWindow.
Parameters:
std::exception |
If the method is called without having first provided a CDisplayWindow3D* to the class instance |
See also:
setWindowManagerPtr, initializeVisuals
virtual void loadParams(const std::string& source_fname)
Load the necessary for the decider/optimizer configuration parameters.
virtual void printParams() const
Print the problem parameters - relevant to the decider/optimizer to the screen in a unified/compact way.
virtual void getDescriptiveReport(std::string* report_str) const
Fill the provided string with a detailed report of the decider/optimizer state.
Report should include (part of) the following:
Timing of important methods
Properties fo class at the current time
Logging of commands until current time