Implemented Priority Queue, added some tests