19 #ifndef HPP_RBPRM_PATH_INTERPOLATION_HH
20 #define HPP_RBPRM_PATH_INTERPOLATION_HH
22 #include <hpp/core/path-vector.hh>
23 #include <hpp/pinocchio/device.hh>
30 typedef std::vector<pinocchio::vector_t,
31 Eigen::aligned_allocator<pinocchio::vector_t> >
34 namespace interpolation {
54 const core::PathVectorConstPtr_t path = core::PathVectorConstPtr_t(),
55 const bool testReachability =
true,
const bool quasiStatic =
false);
72 const std::map<std::string, std::vector<std::string> >& affFilters,
73 const double timeStep = 0.01,
const double robustnessTreshold = 0.,
74 const bool filterStates =
false);
91 const std::map<std::string, std::vector<std::string> >& affFilters,
93 const pinocchio::value_type timeStep = 1.,
94 const pinocchio::value_type initValue = 0.,
95 const bool filterStates =
false);
98 const core::PathVectorConstPtr_t path,
111 const std::vector<std::string> variations);
114 const core::PathVectorConstPtr_t
path_;
139 std::vector<std::string> limbsNames);
140 bool testReachability(
const State& s0,
const State& s1);
145 const State& end,
const bool testReachability =
true,
146 const bool quasiStatic =
false);
151 void init(
const RbPrmInterpolationWkPtr_t& weakPtr);
154 RbPrmInterpolationWkPtr_t weakPtr_;
Definition: rbprm-path-interpolation.hh:43
bool testReachability_
Definition: rbprm-path-interpolation.hh:117
static RbPrmInterpolationPtr_t create(const RbPrmFullBodyPtr_t robot, const State &start, const State &end, const core::PathVectorConstPtr_t path=core::PathVectorConstPtr_t(), const bool testReachability=true, const bool quasiStatic=false)
const State start_
Definition: rbprm-path-interpolation.hh:115
void init(const RbPrmInterpolationWkPtr_t &weakPtr)
Initialization.
rbprm::T_StateFrame Interpolate(const affMap_t &affordances, const std::map< std::string, std::vector< std::string > > &affFilters, const double timeStep=0.01, const double robustnessTreshold=0., const bool filterStates=false)
rbprm::T_StateFrame addGoalConfig(const rbprm::T_StateFrame &states)
addGoalConfig add goal configuration (end_state) at the end of a states list. Modify the last state (...
const State end_
Definition: rbprm-path-interpolation.hh:116
core::Configuration_t configPosition(core::ConfigurationIn_t previous, const core::PathVectorConstPtr_t path, double i)
rbprm::T_StateFrame addGoalConfigRec(const rbprm::T_StateFrame &states, const std::vector< std::string > variations)
const core::PathVectorConstPtr_t path_
Definition: rbprm-path-interpolation.hh:114
rbprm::T_StateFrame Interpolate(const affMap_t &affordances, const std::map< std::string, std::vector< std::string > > &affFilters, const T_Configuration &configs, const double robustnessTreshold=0., const pinocchio::value_type timeStep=1., const pinocchio::value_type initValue=0., const bool filterStates=false)
bool quasiStatic_
Definition: rbprm-path-interpolation.hh:119
RbPrmInterpolation(const core::PathVectorConstPtr_t path, const RbPrmFullBodyPtr_t robot, const State &start, const State &end, const bool testReachability=true, const bool quasiStatic=false)
#define HPP_RBPRM_DLLAPI
Definition: config.hh:64
shared_ptr< RbPrmInterpolation > RbPrmInterpolationPtr_t
Definition: rbprm-path-interpolation.hh:40
HPP_PREDEF_CLASS(ComTrajectory)
hpp::core::Container< hpp::core::AffordanceObjects_t > affMap_t
Definition: rbprm-fullbody.hh:47
std::vector< StateFrame > T_StateFrame
Definition: rbprm-state.hh:34
T_Configuration::const_iterator CIT_Configuration
Definition: rbprm-path-interpolation.hh:33
shared_ptr< RbPrmFullBody > RbPrmFullBodyPtr_t
Definition: kinematics_constraints.hh:11
T_StateFrame::const_iterator CIT_StateFrame
Definition: rbprm-state.hh:35
std::pair< pinocchio::value_type, rbprm::State > StateFrame
Definition: rbprm-state.hh:33
std::vector< pinocchio::vector_t, Eigen::aligned_allocator< pinocchio::vector_t > > T_Configuration
Definition: rbprm-path-interpolation.hh:32
Definition: algorithm.hh:26
Definition: rbprm-state.hh:40