MoveEndEffectorOffsetVectorField.hpp

Go to the documentation of this file.

#ifndef AIKIDO_PLANNER_VECTORFIELD_MOVEENDEFFECTOROFFSETVECTORFIELD_HPP_
#define AIKIDO_PLANNER_VECTORFIELD_MOVEENDEFFECTOROFFSETVECTORFIELD_HPP_
 
#include "aikido/planner/vectorfield/BodyNodePoseVectorField.hpp"
 
namespace aikido {
namespace planner {
namespace vectorfield {
 
class MoveEndEffectorOffsetVectorField : public BodyNodePoseVectorField
{
public:
  MoveEndEffectorOffsetVectorField(
      aikido::statespace::dart::ConstMetaSkeletonStateSpacePtr stateSpace,
      ::dart::dynamics::MetaSkeletonPtr metaskeleton,
      ::dart::dynamics::ConstBodyNodePtr bn,
      const Eigen::Vector3d& direction,
      double minDistance,
      double maxDistance,
      double positionTolerance,
      double angularTolerance,
      double maxStepSize,
      double jointLimitPadding);
 
  // Documentation inherited.
  bool evaluateCartesianVelocity(
      const Eigen::Isometry3d& pose,
      Eigen::Vector6d& cartesianVelocity) const override;
 
  // Documentation inherited.
  VectorFieldPlannerStatus evaluateCartesianStatus(
      const Eigen::Isometry3d& pose) const override;
 
protected:
  Eigen::Vector3d mDirection;
 
  double mMinDistance;
 
  double mMaxDistance;
 
  double mPositionTolerance;
 
  double mAngularTolerance;
 
  Eigen::Isometry3d mStartPose;
 
public:
  EIGEN_MAKE_ALIGNED_OPERATOR_NEW
};
 
} // namespace vectorfield
} // namespace planner
} // namespace aikido
 
#endif // ifndef
       // AIKIDO_PLANNER_VECTORFIELD_MOVEENDEFFECTOROFFSETVECTORFIELD_HPP_