Code for Spimbot competition