31#ifndef HPP_CONSTRAINTS_DISTANCE_BETWEEN_BODIES_HH
32#define HPP_CONSTRAINTS_DISTANCE_BETWEEN_BODIES_HH
36#include <hpp/pinocchio/collision-object.hh>
37#include <hpp/pinocchio/liegroup-element.hh>
38#include <pinocchio/multibody/geometry.hpp>
41namespace constraints {
52 EIGEN_MAKE_ALIGNED_OPERATOR_NEW
74 const std::vector<CollisionObjectPtr_t>& objects);
96 const std::vector<CollisionObjectPtr_t>& objects);
105 if (!DifferentiableFunction::isEqual(other))
return false;
107 if (robot_ != castother.robot_)
return false;
108 if (joint1_ != castother.joint1_)
return false;
109 if (joint2_ != castother.joint2_)
return false;
110 if (data_ != castother.data_)
return false;
116 typedef ::pinocchio::GeometryData GeometryData;
121 mutable GeometryData data_;
122 mutable std::size_t minIndex_;
Definition differentiable-function.hh:63
Definition distance-between-bodies.hh:50
static DistanceBetweenBodiesPtr_t create(const std::string &name, const DevicePtr_t &robot, const JointPtr_t &joint, const std::vector< CollisionObjectPtr_t > &objects)
static EIGEN_MAKE_ALIGNED_OPERATOR_NEW DistanceBetweenBodiesPtr_t create(const std::string &name, const DevicePtr_t &robot, const JointPtr_t &joint1, const JointPtr_t &joint2)
DistanceBetweenBodies(const std::string &name, const DevicePtr_t &robot, const JointPtr_t &joint, const std::vector< CollisionObjectPtr_t > &objects)
DistanceBetweenBodies(const std::string &name, const DevicePtr_t &robot, const JointPtr_t &joint1, const JointPtr_t &joint2)
virtual ~DistanceBetweenBodies()
Definition distance-between-bodies.hh:76
bool isEqual(const DifferentiableFunction &other) const
Definition distance-between-bodies.hh:102
virtual void impl_jacobian(matrixOut_t jacobian, ConfigurationIn_t arg) const
virtual void impl_compute(LiegroupElementRef result, ConfigurationIn_t argument) const
#define HPP_CONSTRAINTS_DLLAPI
Definition config.hh:88
pinocchio::LiegroupElement LiegroupElement
Definition fwd.hh:65
pinocchio::Configuration_t Configuration_t
Definition fwd.hh:105
pinocchio::DevicePtr_t DevicePtr_t
Definition fwd.hh:109
pinocchio::ConfigurationIn_t ConfigurationIn_t
Definition fwd.hh:106
Eigen::Ref< matrix_t > matrixOut_t
Definition fwd.hh:58
shared_ptr< DistanceBetweenBodies > DistanceBetweenBodiesPtr_t
Definition fwd.hh:117
pinocchio::LiegroupElementRef LiegroupElementRef
Definition fwd.hh:66
pinocchio::JointPtr_t JointPtr_t
Definition fwd.hh:49
Definition active-set-differentiable-function.hh:36