private Matrix4d AdjustSourceTargetByTranslation(Matrix4d myMatrixFound, PointCloudVertices pointCloudSource, PointCloudVertices pointCloudTarget) { Matrix3d R = myMatrixFound.ExtractMatrix3d(); Vector3d T = SVD.CalculateTranslation(pointCloudSource.CentroidVector, pointCloudTarget.CentroidVector, R); myMatrixFound = myMatrixFound.AddTranslation(T); return(myMatrixFound); }