Minor pathfinding fixes