Collision and Astar tweaking