Added the priority queue template for the frontier implementing overloaded operators and a compare function.