ConfigurationToTSR.hpp

Go to the documentation of this file.

#ifndef AIKIDO_PLANNER_DART_CONFIGURATIONTOTSR_HPP_
#define AIKIDO_PLANNER_DART_CONFIGURATIONTOTSR_HPP_
 
#include <dart/dart.hpp>
 
#include "aikido/constraint/dart/TSR.hpp"
#include "aikido/planner/Problem.hpp"
#include "aikido/statespace/dart/MetaSkeletonStateSpace.hpp"
#include "aikido/trajectory/Interpolated.hpp"
 
namespace aikido {
namespace planner {
namespace dart {
 
class ConfigurationToTSR : public Problem
{
public:
  ConfigurationToTSR(
      statespace::dart::ConstMetaSkeletonStateSpacePtr stateSpace,
      ::dart::dynamics::ConstMetaSkeletonPtr metaSkeleton,
      ::dart::dynamics::ConstBodyNodePtr endEffectorBodyNode,
      std::size_t maxSamplingTries,
      std::size_t batchSize,
      std::size_t maxBatches,
      std::size_t numMaxIterations,
      constraint::dart::ConstTSRPtr goalTSR,
      constraint::ConstTestablePtr constraint = nullptr);
 
  ConfigurationToTSR(
      statespace::dart::ConstMetaSkeletonStateSpacePtr stateSpace,
      const statespace::dart::MetaSkeletonStateSpace::State* startState,
      ::dart::dynamics::ConstBodyNodePtr endEffectorBodyNode,
      std::size_t maxSamplingTries,
      std::size_t batchSize,
      std::size_t maxBatches,
      std::size_t numMaxIterations,
      constraint::dart::ConstTSRPtr goalTSR,
      constraint::ConstTestablePtr constraint = nullptr);
 
  // Documentation inherited.
  const std::string& getType() const override;
 
  static const std::string& getStaticType();
 
  ::dart::dynamics::ConstBodyNodePtr getEndEffectorBodyNode() const;
 
  std::size_t getMaxSamplingTries() const;
 
  std::size_t getBatchSize() const;
 
  std::size_t getMaxBatches() const;
 
  std::size_t getNumMaxIterations() const;
 
  const statespace::dart::MetaSkeletonStateSpace::State* getStartState() const;
 
  constraint::dart::ConstTSRPtr getGoalTSR() const;
 
protected:
  statespace::dart::ConstMetaSkeletonStateSpacePtr mMetaSkeletonStateSpace;
 
  ::dart::dynamics::ConstMetaSkeletonPtr mMetaSkeleton;
 
  statespace::dart::MetaSkeletonStateSpace::ScopedState mStartState;
 
  const ::dart::dynamics::ConstBodyNodePtr mEndEffectorBodyNode;
 
  std::size_t mMaxSamplingTries;
 
  std::size_t mBatchSize;
 
  std::size_t mMaxBatches;
 
  std::size_t mNumMaxIterations;
 
  const constraint::dart::ConstTSRPtr mGoalTSR;
};
 
} // namespace dart
} // namespace planner
} // namespace aikido
 
#endif // AIKIDO_PLANNER_DART_CONFIGURATIONTOTSR_HPP_