AI logic update && improve FindPath