C code for our 2014 SavageSoccer robot