Added a util.py file that implements a priority queue, vertex, and edge.