SimSTL: Add Implementation of Priority Queue