SO3Angular.hpp

Go to the documentation of this file.

#ifndef AIKIDO_DISTANCE_GEODESICDISTANCEMETRIC_HPP_
#define AIKIDO_DISTANCE_GEODESICDISTANCEMETRIC_HPP_
 
#include "aikido/distance/DistanceMetric.hpp"
#include "aikido/statespace/SO3.hpp"
 
namespace aikido {
namespace distance {
 
class SO3Angular : public DistanceMetric
{
public:
  explicit SO3Angular(std::shared_ptr<const statespace::SO3> _space);
 
  // Documentation inherited
  statespace::ConstStateSpacePtr getStateSpace() const override;
 
  double distance(
      const statespace::StateSpace::State* _state1,
      const statespace::StateSpace::State* _state2) const override;
 
private:
  std::shared_ptr<const statespace::SO3> mStateSpace;
};
 
} // namespace distance
} // namespace aikido
 
#endif