pathfinding fixed a little bit
AI fixes