Add priority quque for implementing PRM