Tests added
astar fixes
fine tuning and tests