Fix double point in Navigation2D

Fixes #10324.
This commit is contained in:
Pedro J. Estébanez 2017-08-16 13:46:10 +02:00
parent 603b262d9b
commit 71a496803c

View File

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