simple distance funtions
begun working on Astar