diff --git a/src/manipulation-planner.cc b/src/manipulation-planner.cc index aed7a214c9a6fd3c38c152bf4ed195f8730663dd..81243621d274ffd9220e6c0348ebb6a6e9f7f320 100644 --- a/src/manipulation-planner.cc +++ b/src/manipulation-planner.cc @@ -53,6 +53,15 @@ namespace hpp { HPP_DEFINE_TIMECOUNTER(buildPath); HPP_DEFINE_TIMECOUNTER(projectPath); HPP_DEFINE_TIMECOUNTER(validatePath); + + bool belongs (const ConfigurationPtr_t& q, const core::Nodes_t& nodes) + { + for (core::Nodes_t::const_iterator itNode = nodes.begin (); + itNode != nodes.end (); ++itNode) { + if (*((*itNode)->configuration ()) == *q) return true; + } + return false; + } } const std::vector<ManipulationPlanner::Reason> @@ -86,15 +95,6 @@ namespace hpp { return shPtr; } - bool belongs (const ConfigurationPtr_t& q, const core::Nodes_t& nodes) - { - for (core::Nodes_t::const_iterator itNode = nodes.begin (); - itNode != nodes.end (); ++itNode) { - if (*((*itNode)->configuration ()) == *q) return true; - } - return false; - } - ManipulationPlanner::ErrorFreqs_t ManipulationPlanner::getEdgeStat (const graph::EdgePtr_t& edge) const { @@ -172,10 +172,7 @@ namespace hpp { delayedEdges.push_back (DelayedEdge_t (near, q_new, path)); } } - } - - } }