closeToDestination method
Indicates if current position is close enough to current destination
Implementation
bool closeToDestination([int pathLength = 3, double distance = 2]) {
return path.length() == pathLength && distanceToDestination() <= distance;
}