Integrated my controller calibration code with Jorge's transmit code