C code for a vex robot controller