add unit test for new ErrorMinimizer (with cov) and fix bug related to them
Merge branch 'master' of github.com:ethz-asl/libpointmatcher