Add ability to switch modes to be from  "Path Finding" to "Treasure Finding"

Add treasures into an List of Treasures and when modes are switched
store the previous goal and make the new goal the closest treasure.
Merge