Skip to content
Snippets Groups Projects
Commit 03b27007 authored by Joseph Mirabel's avatar Joseph Mirabel Committed by Joseph Mirabel
Browse files

Fix bug: avoid repeating the search of possible Edges

parent 1ad7f333
No related branches found
No related tags found
No related merge requests found
......@@ -131,12 +131,6 @@ namespace hpp {
itn2 != nodes.end (); ++itn2) {
ConfigurationPtr_t q2 ((*itn2)->configuration ());
assert (*q1 != *q2);
// Select next node in the constraint graph.
n1 = graph->getNode (*q1);
n2 = graph->getNode (*q2);
possibleEdges = graph->getEdge (n1, n2);
if (possibleEdges.empty())
continue;
path = (*sm) (*q1, *q2);
if (path && pathValidation->validate (path, false, validPath)) {
roadmap ()->addEdge (*itn1, *itn2, path);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment