Code from McMaster Sumobot competition 2014