The code for the subrobotics competition