Added a priority queue test for testing

not optimized