Priority queue, working on insert function.