public override int Extend(List <Point> points, List <double> weigths, bool[] extended)
{
double[] actdata = DataFromPoints(points, weigths, out int addcount);
for (int i = 0; i < 10; i++)
{
this.data[i] += actdata[i];
}
this.actnum += addcount;
Func <Vector <double>, Vector <double> > target = (s) => Fun(s, data[3], data[4], data[5], data[6], data[7], data[8]);
Func <Vector <double>, Matrix <double> > jacobi = (s) => Jacobi(s, data[3], data[4], data[5], data[6], data[7], data[8]);
Vector <double> start = Vector <double> .Build.Dense(4, 0);
for (int i = 0; i < 3; i++)
{
start[i] = this.versor[i];
}
(Vector <double> res_versor, int cnt) = MatrixExt.Fsolve(start, target, jacobi);
this.versor = res_versor;
for (int i = 0; i < 3; i++)
{
this.versor[i] = res_versor[i];
}
this.d = -(data[0] * versor[0] + data[1] * versor[1] + data[2] * versor[2]) / data[9];
return(cnt);
}
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 Generate(List <Point> points, List <double> weights, out int iter, Vector <double> start)
{
this.data = DataFromPoints(points, weights, out this.actnum);
Func <Vector <double>, Vector <double> > target = (s) => Fun(s, data[3], data[4], data[5], data[6], data[7], data[8]);
Func <Vector <double>, Matrix <double> > jacobi = (s) => Jacobi(s, data[3], data[4], data[5], data[6], data[7], data[8]);
(Vector <double> res_versor, int cnt) = MatrixExt.Fsolve(start, target, jacobi);
this.versor = Vector <double> .Build.Dense(3, 0);
for (int i = 0; i < 3; i++)
{
this.versor[i] = res_versor[i];
}
iter = cnt;
this.d = -(data[0] * versor[0] + data[1] * versor[1] + data[2] * versor[2]) / data[9];
/*if (regenerate)
* {
* Regenerate();
* }*/
}