From 2a73cae8a7e08d76e29282cae277cd9d70a54aa0 Mon Sep 17 00:00:00 2001
From: Le Quang Anh <43576719+Toefinder@users.noreply.github.com>
Date: Fri, 18 Mar 2022 18:54:43 +0100
Subject: [PATCH] Fix: correct get transition list
---
src/path-planner/states-path-finder.cc | 2 +-
1 file changed, 1 insertion(+), 1 deletion(-)
diff --git a/src/path-planner/states-path-finder.cc b/src/path-planner/states-path-finder.cc
index 9a59b99..ca82c63 100644
--- a/src/path-planner/states-path-finder.cc
+++ b/src/path-planner/states-path-finder.cc
@@ -424,7 +424,7 @@ namespace hpp {
{
assert (goalDefinedByConstraints_);
Edges_t transitions;
- while (d.queueIt != d.queue1.size()) {
+ while (d.queueIt != d.queue1.size() && transitions.empty()) {
GraphSearchData::state_with_depth_ptr_t _state = d.queue1.at(d.queueIt);
++d.queueIt;
// check that the state is one of the goal states
--
GitLab