Added ability to find nearest node in a graph from arbitrary point on map
and plot astar graph from source to goal.