Fix double point in Navigation2D

Fixes #10324.

(cherry picked from commit 71a496803c)
This commit is contained in:
Pedro J. Estébanez 2017-08-16 13:46:10 +02:00
parent e85be2f5df
commit b64d59f200
1 changed files with 2 additions and 1 deletions

View File

@ -646,7 +646,8 @@ debug path
break;
}
path.push_back(begin_point);
if (path[path.size() - 1].distance_to(begin_point) > CMP_EPSILON)
path.push_back(begin_point);
path.invert();
}