CAbstractHolonomicReactiveMethod.cpp

Go to the documentation of this file.

/* +------------------------------------------------------------------------+
   |                     Mobile Robot Programming Toolkit (MRPT)            |
   |                          http://www.mrpt.org/                          |
   |                                                                        |
   | Copyright (c) 2005-2018, 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 |
   +------------------------------------------------------------------------+ */
 
#include "nav-precomp.h"  // Precomp header
 
#include <mrpt/nav/holonomic/CAbstractHolonomicReactiveMethod.h>
#include <mrpt/serialization/CArchive.h>
 
using namespace mrpt;
using namespace mrpt::nav;
 
IMPLEMENTS_VIRTUAL_SERIALIZABLE(
        CAbstractHolonomicReactiveMethod, CSerializable, mrpt::nav)
 
CAbstractHolonomicReactiveMethod::CAbstractHolonomicReactiveMethod(
        const std::string& defaultCfgSectionName)
        : m_associatedPTG(nullptr),
          m_enableApproachTargetSlowDown(true),
          m_cfgSectionName(defaultCfgSectionName)
{
}
CAbstractHolonomicReactiveMethod::~CAbstractHolonomicReactiveMethod() {}
/** Defines the name of the section (Default: "FULL_EVAL_CONFIG") */
void CAbstractHolonomicReactiveMethod::setConfigFileSectionName(
        const std::string& sectName)
{
        m_cfgSectionName = sectName;
}
std::string CAbstractHolonomicReactiveMethod::getConfigFileSectionName() const
{
        return m_cfgSectionName;
}
 
void CAbstractHolonomicReactiveMethod::setAssociatedPTG(
        mrpt::nav::CParameterizedTrajectoryGenerator* ptg)
{
        m_associatedPTG = ptg;
}
mrpt::nav::CParameterizedTrajectoryGenerator*
        CAbstractHolonomicReactiveMethod::getAssociatedPTG() const
{
        return m_associatedPTG;
}
 
CAbstractHolonomicReactiveMethod::Ptr CAbstractHolonomicReactiveMethod::Factory(
        const std::string& className) noexcept
{
        try
        {
                mrpt::rtti::registerAllPendingClasses();
 
                // Factory:
                const mrpt::rtti::TRuntimeClassId* classId =
                        mrpt::rtti::findRegisteredClass(className);
                if (!classId) return nullptr;
 
                return CAbstractHolonomicReactiveMethod::Ptr(
                        dynamic_cast<CAbstractHolonomicReactiveMethod*>(
                                classId->createObject()));
        }
        catch (...)
        {
                return nullptr;
        }
}
 
CAbstractHolonomicReactiveMethod::NavInput::NavInput()
        : targets(), maxRobotSpeed(1.0), maxObstacleDist(1.0), clearance(nullptr)
{
}
 
CAbstractHolonomicReactiveMethod::NavOutput::NavOutput()
        : desiredDirection(0), desiredSpeed(0)
{
}