public float heuristicDistance(Vector3f goal) { return (float) (location.distance(goal) + getBlockCost()) * TIEBREAKER; }