AStar & Nodes

Added A* and Nodes.  Should work in theory!  Need to test with basic map