Code for my 2014 RobotsConf sumobot