Update to handshake / add ESC calibration