Robot C code for the 2014 season FTC robot competition