Astar debugging started. First fixes done.