i/rtabmap
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap.git synced 2026-09-02 01:20:25 +08:00
Code Issues Packages Projects Releases Wiki Activity

Merge branch 'master' of github.com:introlab/rtabmap into devel

Browse Source
This commit is contained in:
matlabbe
2016-07-08 19:23:05 -04:00
parent 4cd8705710 61f6e5ff79
commit c6439cb1b7
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
corelib/src/Rtabmap.cpp
View File

@@ -3787,7 +3787,7 @@ void Rtabmap::updateGoalIndex()
{ {
if(_localRadius > 0.0f) if(_localRadius > 0.0f)
{ {
distanceFromCurrentNode += _path[i-1].second.getDistance(_path[i].second); distanceFromCurrentNode = _path[_pathCurrentIndex].second.getDistance(_path[i].second);
} }
if((goalIndex == _pathCurrentIndex && i == _path.size()-1) || if((goalIndex == _pathCurrentIndex && i == _path.size()-1) ||