Created some functions that will be usefull for heuristic. Came up with a preliminary heuristic as well.