private void FindCentroids(int N_PTS, ref Vector3 source_centroid, refVector3 target_centroid) { Vector3 p = new Vector3(); for (int i = 0; i < N_PTS; i++) { p = this.SourceLandmarks[i].Position; source_centroid[0] += p[0]; source_centroid[1] += p[1]; source_centroid[2] += p[2]; p = this.TargetLandmarks[i].Position; target_centroid[0] += p[0]; target_centroid[1] += p[1]; target_centroid[2] += p[2]; } source_centroid[0] /= N_PTS; source_centroid[1] /= N_PTS; source_centroid[2] /= N_PTS; target_centroid[0] /= N_PTS; target_centroid[1] /= N_PTS; target_centroid[2] /= N_PTS; }