c++ maze runner showing Best First Search (Priority Queue for next search node)