Add basic priority queue methods

Fleshed out the methods for the priority queue, such as queuing,
dequeuing, and getting the length of the queue.