mirror of
https://github.com/introlab/rtabmap.git
synced 2026-09-02 01:20:25 +08:00
accepting plan of only 1 node
This commit is contained in:
@@ -2327,10 +2327,10 @@ bool Rtabmap::computePath(
|
|||||||
UINFO("Computing path from location %d to %d", currentNode, targetNode);
|
UINFO("Computing path from location %d to %d", currentNode, targetNode);
|
||||||
_path = rtabmap::graph::computePath(nodes, links, currentNode, targetNode);
|
_path = rtabmap::graph::computePath(nodes, links, currentNode, targetNode);
|
||||||
|
|
||||||
if(_path.size()<2)
|
if(_path.size() == 0)
|
||||||
{
|
{
|
||||||
_path.clear();
|
_path.clear();
|
||||||
UWARN("Cannot compute a path (or goal is already reached)!");
|
UWARN("Cannot compute a path!");
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
|
|||||||
Reference in New Issue
Block a user