Updated firmware to work with vex motors. Need to add phidget compatibility