Pathfinding added in