Update force_calibration_matrix_estimator_UNIT.cpp
new force calibration matrix test
improve wrappers