MoveEndEffectorPoseVectorField.hpp

Go to the documentation of this file.

#ifndef AIKIDO_PLANNER_VECTORFIELD_MOVEENDEFFECTORPOSEVECTORFIELD_HPP_
#define AIKIDO_PLANNER_VECTORFIELD_MOVEENDEFFECTORPOSEVECTORFIELD_HPP_
 
#include "aikido/planner/vectorfield/BodyNodePoseVectorField.hpp"
 
namespace aikido {
namespace planner {
namespace vectorfield {
 
class MoveEndEffectorPoseVectorField : public BodyNodePoseVectorField
{
public:
  MoveEndEffectorPoseVectorField(
      aikido::statespace::dart::MetaSkeletonStateSpacePtr stateSpace,
      dart::dynamics::MetaSkeletonPtr metaskeleton,
      dart::dynamics::BodyNodePtr bn,
      const Eigen::Isometry3d& goalPose,
      double poseErrorTolerance,
      double r,
      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::Isometry3d mGoalPose;
 
  double mPoseErrorTolerance;
 
  double mConversionRatioFromRadiusToMeter;
 
public:
  EIGEN_MAKE_ALIGNED_OPERATOR_NEW
};
 
} // namespace vectorfield
} // namespace planner
} // namespace aikido
 
#endif // ifndef
       // AIKIDO_PLANNER_VECTORFIELD_MOVEENDEFFECTORPOSEVECTORFIELD_HPP_