Major updates to AI (Movement + Pathfinding)