Using PriorityQueue instead. Compiles and works.
Moved timetesting to not include printing of map.
Merge pull request #1 from tobyndax/sortedTest2

Sorted test2