ConfigurationToEndEffectorPose.hpp

Go to the documentation of this file.

#ifndef AIKIDO_PLANNER_DART_CONFIGURATIONTOENDEFFECTORPOSE_HPP_
#define AIKIDO_PLANNER_DART_CONFIGURATIONTOENDEFFECTORPOSE_HPP_
 
#include <dart/dart.hpp>
 
#include "aikido/planner/Problem.hpp"
#include "aikido/statespace/dart/MetaSkeletonStateSpace.hpp"
#include "aikido/trajectory/Interpolated.hpp"
 
namespace aikido {
namespace planner {
namespace dart {
 
class ConfigurationToEndEffectorPose : public Problem
{
public:
  ConfigurationToEndEffectorPose(
      statespace::dart::ConstMetaSkeletonStateSpacePtr stateSpace,
      ::dart::dynamics::ConstMetaSkeletonPtr metaSkeleton,
      ::dart::dynamics::ConstBodyNodePtr endEffectorBodyNode,
      const Eigen::Isometry3d& goalPose,
      constraint::ConstTestablePtr constraint = nullptr);
 
  ConfigurationToEndEffectorPose(
      statespace::dart::ConstMetaSkeletonStateSpacePtr stateSpace,
      const statespace::dart::MetaSkeletonStateSpace::State* startState,
      ::dart::dynamics::ConstBodyNodePtr endEffectorBodyNode,
      const Eigen::Isometry3d& goalPose,
      constraint::ConstTestablePtr constraint = nullptr);
 
  // Documentation inherited.
  const std::string& getType() const override;
 
  static const std::string& getStaticType();
 
  ::dart::dynamics::ConstBodyNodePtr getEndEffectorBodyNode() const;
 
  const statespace::dart::MetaSkeletonStateSpace::State* getStartState() const;
 
  const Eigen::Isometry3d& getGoalPose() const;
 
protected:
  // Need this due to mGoalPose.
  EIGEN_MAKE_ALIGNED_OPERATOR_NEW
 
  statespace::dart::ConstMetaSkeletonStateSpacePtr mMetaSkeletonStateSpace;
 
  ::dart::dynamics::ConstMetaSkeletonPtr mMetaSkeleton;
 
  statespace::dart::MetaSkeletonStateSpace::ScopedState mStartState;
 
  const ::dart::dynamics::ConstBodyNodePtr mEndEffectorBodyNode;
 
  const Eigen::Isometry3d mGoalPose;
};
 
} // namespace dart
} // namespace planner
} // namespace aikido
 
#endif // AIKIDO_PLANNER_DART_CONFIGURATIONTOENDEFFECTORPOSE_HPP_