Pathfinding and basic "pick random point and go to it" working