Progress stats

Add a legend to the map with info like number of nodes searched and progress percent (distance traveled divided by total distance from start to goal as the crow flies).

A* is crudely implemented, will need some elbow grease to not be horrible. Others soon to be done