Fix crash at end of make test for xsens classes