Now using boost's adjacency list
Using astar from boost