Implemented Queue, PriorityQueue, and A* star search algo, plus minor streamlining