Shape-fitting now uses DECOMP_SVD (i.e. pseudo-inverse in many cases) and works correctly