Added ESC self calibration