From cff869ad0332e250c9916154325f8d11066b996a Mon Sep 17 00:00:00 2001 From: Mathieu Labbe Date: Fri, 6 Feb 2015 16:44:38 -0500 Subject: [PATCH] accepting plan of only 1 node --- corelib/src/Rtabmap.cpp | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/corelib/src/Rtabmap.cpp b/corelib/src/Rtabmap.cpp index 042a7088..22be4120 100644 --- a/corelib/src/Rtabmap.cpp +++ b/corelib/src/Rtabmap.cpp @@ -2327,10 +2327,10 @@ bool Rtabmap::computePath( UINFO("Computing path from location %d to %d", currentNode, targetNode); _path = rtabmap::graph::computePath(nodes, links, currentNode, targetNode); - if(_path.size()<2) + if(_path.size() == 0) { _path.clear(); - UWARN("Cannot compute a path (or goal is already reached)!"); + UWARN("Cannot compute a path!"); } else {