Added code for SearchNode compareTo and equals. Added initial code for BFS PriorityQueue intialization.