calibration: bugs fixed, mavlink messages cleanup