hpp-manipulation
4.15.1
Classes for manipulation planning.
|
Go to the documentation of this file.
29 #ifndef HPP_MANIPULATION_GRAPH_HELPER_HH
30 #define HPP_MANIPULATION_GRAPH_HELPER_HH
41 namespace manipulation {
52 nc.reserve(a.size() + b.size());
53 std::copy(a.begin(), a.end(), nc.begin());
54 std::copy(b.begin(), b.end(), nc.begin());
72 std::copy(
lj.begin(),
lj.end(), both.
lj.end());
73 std::copy(other.
lj.begin(), other.
lj.end(), both.
lj.end());
82 bool empty()
const {
return lj.empty() &&
nc.empty(); }
112 const std::string& forwName,
const std::string& backName,
117 const bool levelSetPlace,
155 typedef std::tuple<ImplicitPtr_t, ImplicitPtr_t, LockedJoints_t>
165 typedef std::tuple<PlacementConstraint_t, Handles_t, std::size_t>
Object_t;
184 const std::string& graphName,
const Strings_t& griNames,
185 const std::vector<ObjectDef_t>& objs,
194 #endif // HPP_MANIPULATION_GRAPH_HELPER_HH
shared_ptr< LevelSetEdge > LevelSetEdgePtr_t
Definition: fwd.hh:51
pinocchio::GripperPtr_t GripperPtr_t
Definition: fwd.hh:52
std::vector< Object_t > Objects_t
Definition: helper.hh:166
bool link_
Definition: helper.hh:99
void relaxedPlacementManifold(const ImplicitPtr_t placement, const ImplicitPtr_t preplacement, const LockedJoints_t objectLocks, FoliatedManifold &place, FoliatedManifold &preplace)
Edges_t createEdges(const std::string &forwName, const std::string &backName, const StatePtr_t &from, const StatePtr_t &to, const size_type &wForw, const size_type &wBack, const FoliatedManifold &grasp, const FoliatedManifold &pregrasp, const FoliatedManifold &place, const FoliatedManifold &preplace, const bool levelSetGrasp, const bool levelSetPlace, const FoliatedManifold &submanifoldDef=FoliatedManifold())
hpp::core::LockedJoints_t LockedJoints_t
Definition: fwd.hh:65
void addToState(StatePtr_t comp) const
std::vector< Rule > Rules_t
Definition: helper.hh:103
Strings_t shapes
Definition: helper.hh:180
@ GraspOnly
Definition: helper.hh:87
NumericalConstraints_t nc_path
Definition: helper.hh:62
std::vector< EdgePtr_t > Edges_t
Definition: fwd.hh:57
LockedJoints_t lj
Definition: helper.hh:61
Definition: helper.hh:178
core::value_type value_type
Definition: fwd.hh:90
std::vector< HandlePtr_t > Handles_t
Definition: helper.hh:157
GraspingCase
Definition: helper.hh:85
bool empty() const
Definition: helper.hh:82
LockedJoints_t lj_fol
Definition: helper.hh:65
shared_ptr< Handle > HandlePtr_t
Definition: fwd.hh:59
void addToEdge(EdgePtr_t comp) const
bool foliated() const
Definition: helper.hh:81
void specifyFoliation(LevelSetEdgePtr_t lse) const
shared_ptr< Graph > GraphPtr_t
Definition: fwd.hh:47
std::tuple< PlacementConstraint_t, Handles_t, std::size_t > Object_t
Definition: helper.hh:165
void graspManifold(const GripperPtr_t &gripper, const HandlePtr_t &handle, FoliatedManifold &grasp, FoliatedManifold &pregrasp)
Strings_t handles
Definition: helper.hh:180
@ NoPlace
Definition: helper.hh:91
NumericalConstraints_t merge_nc(const NumericalConstraints_t &a, const NumericalConstraints_t &b)
Definition: helper.hh:49
constraints::ImplicitPtr_t ImplicitPtr_t
Definition: fwd.hh:116
@ WithPreGrasp
Definition: helper.hh:88
NumericalConstraints_t nc
Definition: helper.hh:60
FoliatedManifold merge(const FoliatedManifold &other)
Definition: helper.hh:67
hpp::core::NumericalConstraints_t NumericalConstraints_t
Definition: fwd.hh:64
Rule()
Definition: helper.hh:100
NumericalConstraints_t nc_fol
Definition: helper.hh:64
shared_ptr< State > StatePtr_t
Definition: fwd.hh:48
std::vector< std::string > Strings_t
Definition: fwd.hh:144
core::size_type size_type
Definition: fwd.hh:91
PlacementCase
Definition: helper.hh:90
std::vector< std::string > handles_
Definition: helper.hh:98
void graphBuilder(const ProblemSolverPtr_t &ps, const Objects_t &objects, const Grippers_t &grippers, GraphPtr_t graph, const Rules_t &rules=Rules_t())
@ PlaceOnly
Definition: helper.hh:92
std::vector< std::string > grippers_
Definition: helper.hh:97
shared_ptr< Edge > EdgePtr_t
Definition: fwd.hh:49
EdgePtr_t createLoopEdge(const std::string &loopName, const StatePtr_t &state, const size_type &w, const bool levelSet, const FoliatedManifold &submanifoldDef=FoliatedManifold())
Definition: problem-solver.hh:45
std::string name
Definition: helper.hh:179
void strictPlacementManifold(const ImplicitPtr_t placement, const ImplicitPtr_t preplacement, const ImplicitPtr_t placementComplement, FoliatedManifold &place, FoliatedManifold &preplace)
std::tuple< ImplicitPtr_t, ImplicitPtr_t, LockedJoints_t > PlacementConstraint_t
Definition: helper.hh:156
std::vector< GripperPtr_t > Grippers_t
Definition: helper.hh:158
@ NoGrasp
Definition: helper.hh:86
@ WithPrePlace
Definition: helper.hh:93