Exemplo n.º 1
0
        public static double Solve(List <Vector3> points, int dropCount)
        {
            PlaneFitter    pf        = new PlaneFitter();
            List <Vector3> tmpPoints = new List <Vector3>();
            double         maxDist   = double.MinValue;
            int            maxDistIndex;
            int            i, j, k;

            if (points.Count - dropCount < 3)
            {
                return(double.NaN);
            }

            tmpPoints = new List <Vector3>();

            for (i = 0; i < points.Count; i++)
            {
                Vector3 p = new Vector3();
                p.X = points[i].X;
                p.Y = points[i].Y;
                p.Z = points[i].Z;
                tmpPoints.Add(p);
            }

            for (k = 0; k < dropCount; k++)
            {
                pf.Points = tmpPoints;
                pf.Solve();

                if (pf.Errored)
                {
                    return(double.NaN);
                }

                //find max distance index
                maxDist      = double.MinValue;
                maxDistIndex = -1;
                for (i = 0; i < tmpPoints.Count; i++)
                {
                    double temp = Distance.Point2Plane(tmpPoints[i], pf.A, pf.B, pf.C, pf.D);
                    if (double.IsNaN(temp))
                    {
                        return(double.NaN);
                    }
                    if (maxDist < temp)
                    {
                        maxDist      = temp;
                        maxDistIndex = i;
                    }
                }
                //remove max distance point
                tmpPoints.RemoveAt(maxDistIndex);
            }

            return(Solve(tmpPoints));
        }
Exemplo n.º 2
0
        public static double Solve(List <Vector3> points, int dropCount, List <Vector3> referecePlanePoints)
        {
            if (dropCount >= points.Count)
            {
                return(double.NaN);
            }

            PlaneFitter pf = new PlaneFitter();

            pf.Points = referecePlanePoints;
            pf.Solve();

            if (pf.Errored)
            {
                return(double.NaN);
            }

            List <double> dists = new List <double>();

            int i;

            for (i = 0; i < points.Count; i++)
            {
                double temp = Distance.Point2PlaneSigned(points[i], pf.A, pf.B, pf.C, pf.D);
                if (double.IsNaN(temp))
                {
                    return(double.NaN);
                }
                dists.Add(temp);
            }
            dists.Sort();

            for (i = 0; i < dropCount; i++)
            {
                dists.RemoveAt(dists.Count - 1);
            }

            double result = System.Math.Abs(dists[dists.Count - 1] - dists[0]);

            return(result);
        }
Exemplo n.º 3
0
        public static double Solve(List <Vector3> points, List <Vector3> referecePlanePoints)
        {
            PlaneFitter pf = new PlaneFitter();

            pf.Points = referecePlanePoints;
            pf.Solve();

            if (pf.Errored)
            {
                return(double.NaN);
            }

            double max = double.MinValue;
            double min = double.MaxValue;

            int i;

            for (i = 0; i < points.Count; i++)
            {
                double temp = Distance.Point2PlaneSigned(points[i], pf.A, pf.B, pf.C, pf.D);
                if (double.IsNaN(temp))
                {
                    return(double.NaN);
                }
                if (max < temp)
                {
                    max = temp;
                }
                if (min > temp)
                {
                    min = temp;
                }
            }

            double result = max - min;

            return(result);
        }