Parasol Planning Library (PPL)
WeightedEuclideanDistance Class Reference

#include <WeightedEuclideanDistance.h>

Inheritance diagram for WeightedEuclideanDistance:
Inheritance graph
[legend]
Collaboration diagram for WeightedEuclideanDistance:
Collaboration graph
[legend]

Public Member Functions

Construction
 WeightedEuclideanDistance ()
 
 WeightedEuclideanDistance (XMLNode &_node)
 
 WeightedEuclideanDistance (const double _pos, const double _rot, const double _vel, const double _avl)
 
virtual ~WeightedEuclideanDistance ()=default
 
Distance Interface
virtual double Distance (const Cfg &_c1, const Cfg &_c2) override
 
- Public Member Functions inherited from DistanceMetricMethod
 DistanceMetricMethod ()=default
 
 DistanceMetricMethod (XMLNode &_node)
 
virtual ~DistanceMetricMethod ()=default
 
virtual double Distance (const GroupCfgType &_c1, const GroupCfgType &_c2)
 
double EdgeWeight (const RoadmapType *const _r, const typename RoadmapType::CEI &_edge) noexcept
 
double EdgeWeight (const RoadmapType *const _r, const VID _source, const VID _target) noexcept
 
virtual void ScaleCfg (double _length, Cfg &_c, const Cfg &_o)
 
void ScaleCfg (double _length, Cfg &_c)
 
virtual void ScaleCfg (double _length, GroupCfgType &_c, const GroupCfgType &_o)
 
void ScaleCfg (double _length, GroupCfgType &_c)
 
- Public Member Functions inherited from MPBaseObject
 MPBaseObject (const std::string &_label="", const std::string &_name="", bool _debug=false)
 
 MPBaseObject (XMLNode &_node)
 
virtual ~MPBaseObject ()
 
virtual void Print (std::ostream &_os) const
 
virtual void Initialize ()
 
const std::string & GetName () const
 Get the class name for this object. More...
 
const std::string & GetLabel () const
 Get the unique label for this object. More...
 
std::string GetNameAndLabel () const
 Get the unique string identifier for this object "m_name::m_label". More...
 
void SetLabel (const std::string &)
 Set the unique label for this object. More...
 
void SetMPLibrary (MPLibrary *) noexcept
 Set the owning MPLibrary. More...
 
MPLibraryGetMPLibrary () const noexcept
 Get the owning MPLibrary. More...
 
bool IsRunning () const noexcept
 Check the library's running flag. More...
 
MPProblemGetMPProblem () const noexcept
 Get the library's current MPProblem. More...
 
EnvironmentGetEnvironment () const noexcept
 Get the current environment. More...
 
MPTaskGetTask () const noexcept
 Get the current task. More...
 
GroupTaskGetGroupTask () const noexcept
 Get the current group task. More...
 
MPSolutionTypeGetMPSolution () const noexcept
 
RoadmapTypeGetRoadmap (Robot *const _r=nullptr) const noexcept
 Get the current free-space roadmap. More...
 
GroupRoadmapTypeGetGroupRoadmap (RobotGroup *const _g=nullptr) const noexcept
 Get the current free-space group roadmap. More...
 
RoadmapTypeGetBlockRoadmap (Robot *const _r=nullptr) const noexcept
 Get the current obstacle-space roadmap. More...
 
PathGetPath (Robot *const _r=nullptr) const noexcept
 
GroupPathGetGroupPath (RobotGroup *const _g=nullptr) const noexcept
 Get the current best group path. More...
 
StatClassGetStatClass () const noexcept
 Get the current StatClass. More...
 
LocalObstacleMapGetLocalObstacleMap () const noexcept
 Get the local obstacle map. More...
 

Protected Attributes

Internal State
double m_posW {.25}
 Position weight. More...
 
double m_rotW {.25}
 Rotation weight. More...
 
double m_velW {.25}
 Linear velocity weight. More...
 
double m_avlW {.25}
 Angular velocity weight. More...
 
- Protected Attributes inherited from MPBaseObject
bool m_debug
 Print debug info? More...
 

Additional Inherited Members

- Public Types inherited from DistanceMetricMethod
typedef MPBaseObject::RoadmapType RoadmapType
 
typedef RoadmapType::VID VID
 
typedef MPBaseObject::GroupCfgType GroupCfgType
 
typedef GroupCfgType::Formation Formation
 
- Public Types inherited from MPBaseObject
typedef DefaultWeight< CfgWeightType
 
typedef GenericStateGraph< Cfg, WeightTypeRoadmapType
 
typedef GroupCfg< RoadmapTypeGroupCfgType
 
typedef GroupLocalPlan< RoadmapTypeGroupWeightType
 
typedef GroupRoadmap< GroupCfgType, GroupWeightTypeGroupRoadmapType
 
- Protected Member Functions inherited from MPBaseObject
void SetName (const std::string &_s)
 
const std::string & GetBaseFilename () const
 

Detailed Description

Weighted Euclidean distance in State space will have four weight components: position, rotation, velocity, and angular velocity.

Todo:
This doesn't work properly for linked robots. An additional weighting is required for the joint space, which is currently wrapped up with orientation.

Constructor & Destructor Documentation

◆ WeightedEuclideanDistance() [1/3]

WeightedEuclideanDistance::WeightedEuclideanDistance ( )

◆ WeightedEuclideanDistance() [2/3]

WeightedEuclideanDistance::WeightedEuclideanDistance ( XMLNode _node)

◆ WeightedEuclideanDistance() [3/3]

WeightedEuclideanDistance::WeightedEuclideanDistance ( const double  _pos,
const double  _rot,
const double  _vel,
const double  _avl 
)

◆ ~WeightedEuclideanDistance()

virtual WeightedEuclideanDistance::~WeightedEuclideanDistance ( )
virtualdefault

Member Function Documentation

◆ Distance()

double WeightedEuclideanDistance::Distance ( const Cfg _c1,
const Cfg _c2 
)
overridevirtual

Compute a distance between two configurations.

Parameters
_c1The first configuration.
_c2The second configuration.
Returns
The computed distance between _c1 and _c2.

Implements DistanceMetricMethod.

Field Documentation

◆ m_avlW

double WeightedEuclideanDistance::m_avlW {.25}
protected

Angular velocity weight.

◆ m_posW

double WeightedEuclideanDistance::m_posW {.25}
protected

Position weight.

◆ m_rotW

double WeightedEuclideanDistance::m_rotW {.25}
protected

Rotation weight.

◆ m_velW

double WeightedEuclideanDistance::m_velW {.25}
protected

Linear velocity weight.


The documentation for this class was generated from the following files: