Still debugging, the priority queue seems to have some problem