OTS/OTSIncAMeasureApp/0-OTSModel/OTSDataType/CSlopFocusParam.cs

using OTSDataType;
using System;
using System.Collections.Generic;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Xml;

namespace OTSMeasureApp._0_OTSModel.OTSDataType
{
    public struct SpacePoint
    {
        public SpacePoint(double x, double y, double z)
        {
            this.x = x;
            this.y = y;
            this.z = z;
        }
        public double x;
        public double y;
        public double z;

    }
    public struct Vec3
    {
        public double a;
        public double b;
        public double c;

    }
    public class CSlopFocusParam : ISlo
    {
        private bool m_IsUsingSlopParam=false;
        private Point m_FirstPoint;
        private double m_FirstWD=0;
        private Point m_SecondPoint;
        private double m_SecondWD=0;
        private Point m_ThirdPoint;
        private double m_ThirdWD=0;

        public bool IsUsingSlopParam { get => m_IsUsingSlopParam; set => m_IsUsingSlopParam = value; }
        public Point FirstPoint { get => m_FirstPoint; set => m_FirstPoint = value; }
        public double FirstWD { get => m_FirstWD; set => m_FirstWD = value; }
        public Point SecondPoint { get => m_SecondPoint; set => m_SecondPoint = value; }
        public double SecondWD { get => m_SecondWD; set => m_SecondWD = value; }
        public Point ThirdPoint { get => m_ThirdPoint; set => m_ThirdPoint = value; }
        public double ThirdWD { get => m_ThirdWD; set => m_ThirdWD = value; }
        public double GetWD(PointF currentPoint)
        {
            double a=0, b=0, c=0, d=0;
            SpacePoint p1 = new SpacePoint(FirstPoint.X,FirstPoint.Y,FirstWD);
            SpacePoint p2 = new SpacePoint(SecondPoint.X, SecondPoint.Y, SecondWD);
            SpacePoint p3 = new SpacePoint(ThirdPoint.X, ThirdPoint.Y, ThirdWD);
            get_panel(p1, p2, p3,ref a,ref b,ref c, ref d);
            double wd;
            wd = ((0 - d) - (a * currentPoint.X + b * currentPoint.Y)) / c;
            return wd;
        
        }
 
        //已知3点坐标，求平面ax+by+cz+d=0;

        void get_panel(SpacePoint p1, SpacePoint p2, SpacePoint p3, ref double a, ref double b, ref double c, ref double d)

        {

            a = (p2.y - p1.y) * (p3.z - p1.z) - (p2.z - p1.z) * (p3.y - p1.y);

            b = (p2.z - p1.z) * (p3.x - p1.x) - (p2.x - p1.x) * (p3.z - p1.z);

            c = (p2.x - p1.x) * (p3.y - p1.y) - (p2.y - p1.y) * (p3.x - p1.x);

            d = 0 - (a * p1.x + b * p1.y + c * p1.z);

        }


        // 已知三点坐标，求法向量

        Vec3 get_Normal(SpacePoint p1, SpacePoint p2, SpacePoint p3)

        {
            double a, b, c;
            a = (p2.y - p1.y) * (p3.z - p1.z) - (p2.z - p1.z) * (p3.y - p1.y);

            b = (p2.z - p1.z) * (p3.x - p1.x) - (p2.x - p1.x) * (p3.z - p1.z);

            c = (p2.x - p1.x) * (p3.y - p1.y) - (p2.y - p1.y) * (p3.x - p1.x);

            Vec3 v= new Vec3();
            v.a = a;
            v.b = b;
            v.c = c;
            return v;

        }


        //点到平面距离

        double dis_pt2panel(SpacePoint pt, double a, double b, double c, double d)
        {

            return Math.Abs(a * pt.x + b * pt.y + c * pt.z + d) / Math.Sqrt(a * a + b * b + c * c);

        }

        public override void Serialize(bool isStoring, XmlDocument classDoc, XmlNode rootNode)
        {
            xBool xtoRun = new xBool();
            xInt xX1 = new xInt();      
           
            xInt xY1 = new xInt();

            xInt xX2 = new xInt();
            xInt xY2 = new xInt();
         
            xInt xX3 = new xInt();
            xInt xY3 = new xInt();
          
            xDouble xWD1 = new xDouble();
            xDouble xWD2 = new xDouble();
            xDouble xWD3 = new xDouble();
           
                Slo slo = new Slo();
            slo.Register("toRun",xtoRun);    
            slo.Register("X1", xX1);
            slo.Register("Y1", xY1);
            slo.Register("X2", xX2);
            slo.Register("Y2", xY2);
            slo.Register("X3", xX3);
            slo.Register("Y3", xY3);
           
            slo.Register("WD1", xWD1);
            slo.Register("WD2", xWD2);
            slo.Register("WD3", xWD3);
            if (isStoring)
            {
                xtoRun.AssignValue(IsUsingSlopParam);
                xX1.AssignValue(FirstPoint.X);
                xY1.AssignValue(FirstPoint.Y);
                xX2.AssignValue(SecondPoint.X);
                xY2.AssignValue(SecondPoint.Y);
                xX3.AssignValue(ThirdPoint.X);
                xY3.AssignValue(ThirdPoint.Y);
                xWD1.AssignValue(FirstWD);
                xWD2.AssignValue(SecondWD);
                xWD3.AssignValue(ThirdWD);
               

                slo.Serialize(true, classDoc, rootNode);
            }
            else
            {
                slo.Serialize(false, classDoc, rootNode);
                IsUsingSlopParam = xtoRun.value();
                m_FirstPoint.X = xX1.value();
                m_FirstPoint.Y = xY1.value();
                m_SecondPoint.X = xX2.value();
                m_SecondPoint.Y = xY2.value();
                m_ThirdPoint.X = xX3.value();
                m_ThirdPoint.Y = xY3.value();
                m_FirstWD=xWD1.value(); 
                m_SecondWD=xWD2.value();    
                m_ThirdWD=xWD3.value();


            }
        }
    }
}