Aikido
|
Computes the shortest distance between two states in SE2. More...
#include <aikido/distance/SE2Weighted.hpp>
Public Member Functions | |
SE2Weighted (std::shared_ptr< const statespace::SE2 > space) | |
Constructor. More... | |
SE2Weighted (std::shared_ptr< const statespace::SE2 > space, const Eigen::Vector2d &weights) | |
Constructor. More... | |
statespace::ConstStateSpacePtr | getStateSpace () const override |
Get the StateSpace associated with this metric. More... | |
double | distance (const statespace::StateSpace::State *state1, const statespace::StateSpace::State *state2) const override |
Computes weighted distance between two SE2 states. More... | |
![]() | |
virtual | ~DistanceMetric ()=default |
Destructor. More... | |
Private Attributes | |
std::shared_ptr< const statespace::SE2 > | mStateSpace |
Eigen::Vector2d | mWeights |
Computes the shortest distance between two states in SE2.
|
explicit |
Constructor.
space | The SE2 this distance metric operates on The weights have been set to 1 as default |
aikido::distance::SE2Weighted::SE2Weighted | ( | std::shared_ptr< const statespace::SE2 > | space, |
const Eigen::Vector2d & | weights | ||
) |
Constructor.
It is a vector of 2 elements, the first element corresponds to the weight of translational distance and the second the weight for angular distance
space | The SE2 this distance metric operates on |
weights | The weights over translational and angular distances |
|
overridevirtual |
Computes weighted distance between two SE2 states.
state1 | The first state (type: SE2::State) |
state2 | The second state (type: SE2::State) |
Implements aikido::distance::DistanceMetric.
|
overridevirtual |
Get the StateSpace associated with this metric.
Implements aikido::distance::DistanceMetric.
|
private |
|
private |