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)
{
}