Starting to add best first search implementation