Code used in the finalized and testing 2013 robots