Added functionality of buttons and servos

This was a pain to do. Also we are using the vexRT array, not the
method. This currently has a servo start -127 then to go to 127 when the
6D button is pushed