diff --git a/src/manipulation-planner.cc b/src/manipulation-planner.cc index e6c88fa8f279039e61208d20cfeb9fe5cc58fff0..650cc71bc8600a7594924f124911588cbb1e1a77 100644 --- a/src/manipulation-planner.cc +++ b/src/manipulation-planner.cc @@ -109,8 +109,9 @@ namespace hpp { if (pathIsValid) { value_type t_final = path->timeRange ().second; if (t_final != path->timeRange ().first) { + bool success; ConfigurationPtr_t q_new (new Configuration_t - ((*path) (t_final))); + ((*path) (t_final, success))); if (!belongs (q_new, newNodes)) { newNodes.push_back (roadmap ()->addNodeAndEdges (near, q_new, path));