CTopLCDetector_GridMatching.h

Go to the documentation of this file.

/* +---------------------------------------------------------------------------+
   |                     Mobile Robot Programming Toolkit (MRPT)               |
   |                          http://www.mrpt.org/                             |
   |                                                                           |
   | Copyright (c) 2005-2014, Individual contributors, see AUTHORS file        |
   | See: http://www.mrpt.org/Authors - All rights reserved.                   |
   | Released under BSD License. See details in http://www.mrpt.org/License    |
   +---------------------------------------------------------------------------+ */

#ifndef _CTopLCDetector_GridMatching_H
#define _CTopLCDetector_GridMatching_H

#include <mrpt/hmtslam/CTopLCDetectorBase.h>
#include <mrpt/slam/CGridMapAligner.h>

namespace mrpt
{
        namespace hmtslam
        {
                using namespace mrpt::slam;

                /** \ingroup mrpt_hmtslam_grp */
                class HMTSLAM_IMPEXP CTopLCDetector_GridMatching : public CTopLCDetectorBase
                {
                protected:
                        CTopLCDetector_GridMatching( CHMTSLAM *hmtslam );

                public:
                        /** A class factory, to be implemented in derived classes.
                          */
                        static CTopLCDetectorBase* createNewInstance( CHMTSLAM *hmtslam )
                        {
                                return static_cast<CTopLCDetectorBase*>(new CTopLCDetector_GridMatching(hmtslam));
                        }

                        /** Destructor */
                        virtual ~CTopLCDetector_GridMatching();

                        /** This method must compute the topological observation model.
                          * \param out_log_lik The output, a log-likelihood.
                          * \return NULL, or a PDF of the estimated translation between the two areas (should be a SOG PDF): it's the pose of "refArea", relative to "currentArea".
                          */
                        CPose3DPDFPtr computeTopologicalObservationModel(
                                const THypothesisID             &hypID,
                                const CHMHMapNodePtr    &currentArea,
                                const CHMHMapNodePtr    &refArea,
                                double                                  &out_log_lik
                                 );

                        /** Hook method for being warned about the insertion of a new poses into the maps.
                          *  This should be independent of hypothesis IDs.
                          */
                        void OnNewPose(
                                const TPoseID                   &poseID,
                                const CSensoryFrame             *SF );


                        /** Options for a TLC-detector of type gridmap-matching, used from CHMTSLAM 
                          */
                        struct TOptions : public utils::CLoadableOptions
                        {
                                /** Initialization of default params
                                  */
                                TOptions();


                                /** Options for the grid-to-grid matching algorithm */
                                mrpt::slam::CGridMapAligner::TConfigParams      matchingOptions;

                                /** Load parameters from configuration source
                                  */
                                void  loadFromConfigFile(
                                        const mrpt::utils::CConfigFileBase      &source,
                                        const std::string               &section);

                                /** This method must display clearly all the contents of the structure in textual form, sending it to a CStream.
                                  */
                                void  dumpToTextStream(CStream  &out) const;

                        };

                }; // end class

        } // end namespace
} // end namespace


#endif