added path construction to astar, call it from main (it doesnt work, tada!)