Arduino code for mini sumo robot