Implemented the PriorityQueue. It should work. Just need to do some unit testing on it.