added some code to control the robot during the zumo contest, not tested