Initial evaluatePoints function for finding obstacles not on the static map