Update force_calibration_matrix_estimator_UNIT.cpp