fixing the rigid cube exploding bug by forcing the svd of the rotation matrix be identity matrix of scaling factors