Tree Based Priority Queue Fix