Make priority queue only store agent location rather than entire nodes (to keep things the same as in the book).
Make Node and NodePriorityQueue more friendly for the AI to deal with.