fixes and issue where last point in path is near destination