19 #ifndef HPP_CORE_ROADMAP_HH 20 # define HPP_CORE_ROADMAP_HH 28 # include <hpp/util/serialization-fwd.hh> 43 virtual void clear ();
64 value_type& minDistance,
bool reverse =
false);
69 return nearestNode (*configuration, minDistance, reverse);
80 value_type& minDistance,
bool reverse =
false);
86 return nearestNode (*configuration, connectedComponent, minDistance, reverse);
100 return nearestNodes (*configuration, k);
119 return nearestNodes (*configuration, connectedComponent, k);
193 initNode_ = addNode (config);
198 bool pathExists ()
const;
230 std::ostream& print (std::ostream& os)
const;
242 void addConnectedComponent (
const NodePtr_t& node);
248 nodes_.push_back (n);
260 virtual void impl_addEdge (
const EdgePtr_t& e);
268 void init (RoadmapWkPtr_t weak);
301 RoadmapWkPtr_t weak_;
309 #endif // HPP_CORE_ROADMAP_HH
pinocchio::DevicePtr_t DevicePtr_t
Definition: fwd.hh:114
Definition: bi-rrt-planner.hh:24
pinocchio::size_type size_type
Definition: fwd.hh:156
virtual void push_node(const NodePtr_t &n)
Definition: roadmap.hh:246
Optimization of the nearest neighbor search.
Definition: nearest-neighbor.hh:28
shared_ptr< Distance > DistancePtr_t
Definition: fwd.hh:122
NodePtr_t addNode(const Configuration_t &config)
Definition: roadmap.hh:53
std::set< ConnectedComponentPtr_t > ConnectedComponents_t
Definition: fwd.hh:108
shared_ptr< ConnectedComponent > ConnectedComponentPtr_t
Definition: fwd.hh:107
std::list< NodePtr_t > Nodes_t
Definition: fwd.hh:164
pinocchio::value_type value_type
Definition: fwd.hh:157
std::set< RawPtr_t > RawPtrs_t
Definition: connected-component.hh:35
Roadmap()
Definition: roadmap.hh:237
Nodes_t nearestNodes(const ConfigurationPtr_t &configuration, size_type k)
Definition: roadmap.hh:97
shared_ptr< Roadmap > RoadmapPtr_t
Definition: fwd.hh:182
const Nodes_t & nodes() const
Definition: roadmap.hh:199
Nodes_t nearestNodes(const ConfigurationPtr_t &configuration, const ConnectedComponentPtr_t &connectedComponent, size_type k)
Definition: roadmap.hh:114
pinocchio::ConfigurationPtr_t ConfigurationPtr_t
Definition: fwd.hh:99
std::vector< NodePtr_t > NodeVector_t
Definition: fwd.hh:165
std::list< Edge * > Edges_t
Definition: fwd.hh:127
void initNode(const ConfigurationPtr_t &config)
Definition: roadmap.hh:191
void resetGoalNodes()
Definition: roadmap.hh:186
NodePtr_t nearestNode(const ConfigurationPtr_t &configuration, const ConnectedComponentPtr_t &connectedComponent, value_type &minDistance, bool reverse=false)
Definition: roadmap.hh:82
NodePtr_t nearestNode(const ConfigurationPtr_t &configuration, value_type &minDistance, bool reverse=false)
Definition: roadmap.hh:66
const Edges_t & edges() const
Definition: roadmap.hh:203
std::ostream & operator<<(std::ostream &os, const Constraint &constraint)
Definition: constraint.hh:101
#define HPP_CORE_DLLAPI
Definition: config.hh:64
pinocchio::Configuration_t Configuration_t
Definition: fwd.hh:96
const NodeVector_t & goalNodes() const
Definition: roadmap.hh:211
Definition: roadmap.hh:37
NodePtr_t initNode() const
Definition: roadmap.hh:207
shared_ptr< Path > PathPtr_t
Definition: fwd.hh:170