A* with avoidance working