Update force_calibration_matrix_estimator.cpp