public void Generate(Point[] points, out int iter, Vector <double> start, bool regenerate = true) { int n = points.Length; double[] x = new double[n]; double[] y = new double[n]; double[] z = new double[n]; for (int i = 0; i < n; i++) { x[i] = points[i].x; y[i] = points[i].y; z[i] = points[i].z; } Vector <double> Vx = Vector <double> .Build.DenseOfArray(x); Vector <double> Vy = Vector <double> .Build.DenseOfArray(y); Vector <double> Vz = Vector <double> .Build.DenseOfArray(z); double Mx = Vx.Average(); double My = Vy.Average(); double Mz = Vz.Average(); Vx -= Mx; Vy -= My; Vz -= Mz; double x2 = Vx.DotProduct(Vx); double y2 = Vy.DotProduct(Vy); double z2 = Vz.DotProduct(Vz); double xy = Vx.DotProduct(Vy); double xz = Vx.DotProduct(Vz); double yz = Vy.DotProduct(Vz); Func <Vector <double>, Vector <double> > target = (s) => Fun(s, x2, y2, z2, xy, yz, xz); Func <Vector <double>, Matrix <double> > jacobi = (s) => Jacobi(s, x2, y2, z2, xy, yz, xz); (Vector <double> res_versor, int cnt) = MatrixExt.Fsolve(start, target, jacobi); this.versor = res_versor; iter = cnt; this.d = -(Mx * versor[0] + My * versor[1] + Mz * versor[2]); double dist; disp = 0; Connected.Clear(); for (int i = 0; i < n; i++) { if ((dist = Distance(points[i])) < Control.AcceptRangePlain) { Connected.Add(points[i]); disp += dist * dist; } } pointnum = Connected.Count; if (regenerate) { Regenerate(); } }
public void clearConnected() { Connected.Clear(); }