XzXdDw/XzXdDw.App/Api/低轨GDOP误差椭圆/ErrEllipseHelper.cs

using DevExpress.Charts.Native;
using DevExpress.Internal.WinApi.Windows.UI.Notifications;
using DevExpress.XtraPrinting;
using Newtonsoft.Json;
using System;
using System.Collections.Generic;
using System.Diagnostics;
using System.IO;
using System.Linq;
using System.Runtime.InteropServices;
using System.Text;
using System.Threading.Tasks;
using XdCxRhDW.App.Api.时差线;
using XdCxRhDW.App.DTO;
using static System.Windows.Forms.VisualStyles.VisualStyleElement.TaskbarClock;

namespace XzXdDw.App.Api.低轨GDOP误差椭圆
{
    public class ErrorEllipseDTFOTSOption
    {
        /// <summary>
        /// 主星星历
        /// </summary>
        public double[] MsEph { get; set; }

        /// <summary>
        /// 邻星星历
        /// </summary>
        public double[] NsEph { get; set; }

        /// <summary>
        /// 参考站位置
        /// </summary>
        public double[] RefGeod { get; set; }

        /// <summary>
        /// 定位点
        /// </summary>
        public double[] SelectPoint { get; set; }

        /// <summary>
        /// 时差误差(Hz)
        /// </summary>
        public double DtoErr { get; set; }
        /// <summary>
        /// 频差误差(Hz)
        /// </summary>
        public double DfoErr { get; set; }
        /// <summary>
        /// 星历位置误差
        /// </summary>
        public double EphPosErr { get; set; }
        /// <summary>
        ///星历速度误差
        /// </summary>
        public double EphVelErr { get; set; }
        /// <summary>
        /// 上行频点(Hz)
        /// </summary>
        public double fu { get; set; }
        /// <summary>
        /// 概率 默认0.5
        /// </summary>
        public double Pe { get; set; } = 0.5;

    }

    public class ErrorEllipseDTO2X1DOption
    {
        /// <summary>
        /// 主星星历
        /// </summary>
        public double[] MsEph { get; set; }

        /// <summary>
        /// 邻星星历
        /// </summary>
        public double[] NsEph { get; set; }

        /// <summary>
        /// 超短波位置
        /// </summary>
        public double[] CDBAnt { get; set; }

        /// <summary>
        /// 参考站位置
        /// </summary>
        public double[] RefGeod { get; set; }

        /// <summary>
        /// 定位点
        /// </summary>
        public double[] SelectPoint { get; set; }

        /// <summary>
        /// 时差误差(Hz)
        /// </summary>
        public double DtoErr { get; set; }

        /// <summary>
        /// 星历误差
        /// </summary>
        public double EphErr { get; set; }
        /// <summary>
        /// 概率 默认0.5
        /// </summary>
        public double Pe { get; set; } = 0.5;

    }

    public class ErrorEllipseDTO1XOption
    {
        /// <summary>
        /// 第一时刻星历
        /// </summary>
        public double[] MsEph { get; set; }

        /// <summary>
        ///第二时刻星历
        /// </summary>
        public double[] NsEph1 { get; set; }

        /// <summary>
        /// 第三时刻星历
        /// </summary>
        public double[] NsEph2 { get; set; }

        /// <summary>
        /// 定位点
        /// </summary>
        public double[] SelectPoint { get; set; }

        /// <summary>
        /// 频差误差(Hz)
        /// </summary>
        public double DfoErr { get; set; }
        /// <summary>
        /// 星历位置误差
        /// </summary>
        public double EphPosErr { get; set; }
        /// <summary>
        ///星历速度误差
        /// </summary>
        public double EphVelErr { get; set; }
        /// <summary>
        /// 上行频点(Hz)
        /// </summary>
        public double fu { get; set; }
        /// <summary>
        /// 概率 默认0.5
        /// </summary>
        public double Pe { get; set; } = 0.5;

    }
    public static class ErrEllipseHelper
    {
        public static IEnumerable<(double lon, double lat)> ErrorEllipseDTFOTwoStart(ErrorEllipseDTFOTSOption opt)
        {

            List<DtoLinePoint> list = new List<DtoLinePoint>();

            int LOP_Len = 0;
            IntPtr LOP_ValuePtr = GdopHelper.Error_Ellipse_DTFO(
                opt.MsEph,
                 opt.NsEph,
                opt.RefGeod,
                 opt.SelectPoint,
                opt.DtoErr,
                opt.DfoErr,
               opt.EphPosErr,
               opt.EphVelErr,
               opt.fu, opt.Pe, ref LOP_Len);
            double[] LOP_Value = new double[LOP_Len];
            if (LOP_Len > 0)
            {
                Marshal.Copy(LOP_ValuePtr, LOP_Value, 0, LOP_Value.Length);

                int len = LOP_Len / 2;
                for (int i = 0; i < len; i++)
                {
                    int temp = i * 2;
                    list.Add(new DtoLinePoint()
                    {
                        Lon = LOP_Value[temp],
                        Lat = LOP_Value[temp + 1]
                    });
                }
            }
            var Lines = list.Select(p => (p.Lon, p.Lat));
            return Lines;
        }


        public static IEnumerable<(double lon, double lat)> ErrorEllipse2X1D(ErrorEllipseDTO2X1DOption opt)
        {

            List<DtoLinePoint> list = new List<DtoLinePoint>();

            int LOP_Len = 0;
            IntPtr LOP_ValuePtr = GdopHelper.Error_Ellipse_2X1D(
                opt.MsEph,
                 opt.NsEph,
                 opt.CDBAnt,
                opt.RefGeod,
                 opt.SelectPoint,
                opt.DtoErr,
                opt.EphErr,
                opt.Pe, ref LOP_Len);
            double[] LOP_Value = new double[LOP_Len];
            if (LOP_Len > 0)
            {
                Marshal.Copy(LOP_ValuePtr, LOP_Value, 0, LOP_Value.Length);

                int len = LOP_Len / 2;
                for (int i = 0; i < len; i++)
                {
                    int temp = i * 2;
                    list.Add(new DtoLinePoint()
                    {
                        Lon = LOP_Value[temp],
                        Lat = LOP_Value[temp + 1]
                    });
                }
            }
            var Lines = list.Select(p => (p.Lon, p.Lat));
            return Lines;
        }


        public static IEnumerable<(double lon, double lat)> ErrorEllipseSingleX(ErrorEllipseDTO1XOption opt)
        {

            List<DtoLinePoint> list = new List<DtoLinePoint>();

            int LOP_Len = 0;
            IntPtr LOP_ValuePtr = GdopHelper.Error_Ellipse_2DFO(
                opt.MsEph,
                 opt.NsEph1,
                 opt.NsEph2,
                 opt.SelectPoint,
                opt.DfoErr,
               opt.EphPosErr,
               opt.EphVelErr,
               opt.fu, opt.Pe, ref LOP_Len);
            double[] LOP_Value = new double[LOP_Len];
            if (LOP_Len > 0)
            {
                Marshal.Copy(LOP_ValuePtr, LOP_Value, 0, LOP_Value.Length);

                int len = LOP_Len / 2;
                for (int i = 0; i < len; i++)
                {
                    int temp = i * 2;
                    list.Add(new DtoLinePoint()
                    {
                        Lon = LOP_Value[temp],
                        Lat = LOP_Value[temp + 1]
                    });
                }
            }
            var Lines = list.Select(p => (p.Lon, p.Lat));
            return Lines;
        }

    }
}