Create PriorityQueue.py

Simple Priority Queue to be used in the Robot class, implement in same package as Robot.py