Add tests & intital Priority Queue functionality
Add priority queue and test file