XdCxRhDW/XdCxRhDW.App/UserControl/X3DFGDOPParam .cs

using DevExpress.XtraMap;
using DxHelper;
using ExtensionsDev;
using System;
using System.Collections.Generic;
using System.Data;
using System.Drawing;
using System.Linq;
using XdCxRhDW.Api;
using XdCxRhDW.Entity;
using XdCxRhDW.Repostory;

namespace XdCxRhDW.App.UserControl
{
    public partial class X3DFGDOPParam : DevExpress.XtraEditors.XtraUserControl
    {
        public MapControl mapControl1;
        public X3DFGDOP接口 Model => new X3DFGDOP接口()
        {
            EphMain = ucEphXYZMain.EphParam(),
            EphAdja1 = ucEphXYZAdja1.EphParam(),
            EphAdja2 = ucEphXYZAdja2.EphParam(),
            CapTime = txtCapTime.DateTime,
            RefLon = Convert.ToDouble(txtRefLocation1.Text.Replace("，", ",").Split(',')[0].Trim()),
            RefLat = Convert.ToDouble(txtRefLocation1.Text.Replace("，", ",").Split(',')[1].Trim()),
            DfoErr = Convert.ToDouble(txtDfoErr1.Text),
            SatLocErr = Convert.ToDouble(txtSatLocErr1.Text),
            EphVelErr = Convert.ToDouble(txtEphVelErr1.Text),
            fu1 = Convert.ToDouble(txtFu1.Text) * 1e6,
            fu2 = Convert.ToDouble(txtFu2.Text) * 1e6,
        };
        private EnumPosResType PosResType;
        public X3DFGDOPParam(PosRes item)
        {
            InitializeComponent();
            this.layoutControl1.UseDefault();
            txtCapTime.UseDefault();
            txtRefLocation1.UseDoubleClickToSelectAll();
            this.txtCapTime.DateTime = item.SigTime;
            this.txtSatLocErr1.EditValue = 10000;
            this.txtEphVelErr1.EditValue = 0.1;
            this.txtDfoErr1.EditValue = 0.01;
            PosResType = item.PosResType;
            using (RHDWPartContext db = RHDWPartContext.GetContext(item.SigTime))
            {
                if (db.DatabaseExist)
                {
                    var cg = db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefault();
                    var station = db.StationRes.Where(m => m.ID == item.StationResID).FirstOrDefault();
                    if (station != null)
                    {
                        this.txtRefLocation1.Text = $"{station.RefLon},{station.RefLat}";
                    }
                    if (cg != null)
                    {
                        this.txtFu1.EditValue = cg.TarFreqUp.HasValue ? cg.TarFreqUp.Value * 1e-6 : 950;
                        this.txtFu2.EditValue = cg.RefFreqUp.HasValue ? cg.RefFreqUp.Value * 1e-6 : 950;

                        var mainEph = (cg.MainX, cg.MainY, cg.MainZ, cg.MainVx, cg.MainVy, cg.MainVz);
                        ucEphXYZMain.SetParam($"主星", cg.MainCode, mainEph, Color.Black);

                        var adja1Eph = (cg.Adja1X, cg.Adja1Y, cg.Adja1Z, cg.Adja1Vx, cg.Adja1Vy, cg.Adja1Vz);
                        ucEphXYZAdja1.SetParam($"邻星1", cg.Adja1Code, adja1Eph, Color.Black);

                        var adja2Eph = (cg.Adja2X, cg.Adja2Y, cg.Adja2Z, cg.Adja2Vx, cg.Adja2Vy, cg.Adja2Vz);
                        ucEphXYZAdja2.SetParam($"邻星2", cg.Adja2Code, adja2Eph, Color.Black);
                    }
                }

            }
        }

        private (bool, string) ParamValidate()
        {
            var mainparam = ucEphXYZMain.ValidateParam();
            if (!mainparam.Item1)
            {
                return (false, mainparam.Item2);
            }
            var adja1param = ucEphXYZAdja1.ValidateParam();
            if (!adja1param.Item1)
            {
                return (false, adja1param.Item2);
            }
            var adja2param = ucEphXYZAdja2.ValidateParam();
            if (!adja2param.Item1)
            {
                return (false, adja2param.Item2);
            }
            var refsta = txtRefLocation1.CheckLonLat("参考站");
            if (!refsta.Item1)
            {
                return refsta;
            }
            return (true, "");
        }
        private void btnOK_Click(object sender, EventArgs e)
        {
            var pv = ParamValidate();
            if (!pv.Item1)
            {
                DxHelper.MsgBoxHelper.ShowWarning($"{pv.Item2}");
                return;
            }
            try
            {
                mapControl1.ClearMap();
                var refs = new double[] { Model.RefLon, Model.RefLat, 0 };
                var data = GdopHelper.Gdop3SatDFByXyz(Model.EphMain, Model.EphAdja1, Model.EphAdja2, Model.fu1, Model.fu2, Model.DfoErr, Model.SatLocErr, Model.EphVelErr, refs);

                if (data == null)
                {
                    return;
                }

                foreach (var errLins in data)//画GDOP
                {
                    var mapDots = errLins.MapDots.Select(p => p).Select(p => (p.Lon, p.Lat));
                    mapControl1.DrawGdopLineTwo(errLins.ErrDistanceKm, mapDots, mapDots.Count() / 2);
                }
            }
            catch (Exception ex)
            {
                DxHelper.MsgBoxHelper.ShowError($"绘制{PosResType.GetEnumDisplayName()}GDOP失败,{ex.Message}");
            }
        }

        private void btnClose_Click(object sender, EventArgs e)
        {
            PopupHelper.HidePopup(this);
        }

        private async void btnEphCalc_Click(object sender, EventArgs e)
        {
            if (txtCapTime.DateTime == DateTime.MinValue)
            {
                DxHelper.MsgBoxHelper.ShowWarning("信号时间不能为空!");
                return;
            }
            var sigTime = txtCapTime.DateTime;
            try
            {
                var mainCode = ucEphXYZMain.GetSatCode();
                var adja1Code = ucEphXYZAdja1.GetSatCode();
                var adja2Code = ucEphXYZAdja2.GetSatCode();
                var mainxlInfo = await XlRepository.GetLatestAsync(mainCode, sigTime);
                if (mainxlInfo == null)
                {
                    DxHelper.MsgBoxHelper.ShowWarning($"卫星:{mainCode}未找到对应的星历信息,请导入星历");
                    return;
                }
                var maineph = EphHelper.Calc(mainxlInfo.TwoLine, sigTime);

                ucEphXYZMain.SetParam("主星", mainCode, (maineph.X, maineph.Y, maineph.Z, maineph.VX, maineph.VY, maineph.VZ), Color.Red);



                var adja1xlInfo = await XlRepository.GetLatestAsync(adja1Code, sigTime);
                if (adja1xlInfo == null)
                {
                    DxHelper.MsgBoxHelper.ShowWarning($"卫星:{adja1Code}未找到对应的星历信息,请导入星历");
                    return;
                }
                var adja1eph = EphHelper.Calc(adja1xlInfo.TwoLine, sigTime);

                ucEphXYZAdja1.SetParam("邻星1", adja1Code, (adja1eph.X, adja1eph.Y, adja1eph.Z, adja1eph.VX, adja1eph.VY, adja1eph.VZ), Color.Red);


                var adja2xlInfo = await XlRepository.GetLatestAsync(adja2Code, sigTime);
                if (adja2xlInfo == null)
                {
                    DxHelper.MsgBoxHelper.ShowWarning($"卫星:{adja2Code}未找到对应的星历信息,请导入星历");
                    return;
                }
                var adja2eph = EphHelper.Calc(adja2xlInfo.TwoLine, sigTime);

                ucEphXYZAdja2.SetParam("邻星2", adja2Code, (adja2eph.X, adja2eph.Y, adja2eph.Z, adja2eph.VX, adja2eph.VY, adja2eph.VZ), Color.Red);
            }
            catch (Exception ex)
            {
                Serilog.Log.Error(ex, $"手动推算{PosResType.GetEnumDisplayName()}星历失败,SigTime={sigTime}");
                DxHelper.MsgBoxHelper.ShowError($"手动推算{PosResType.GetEnumDisplayName()}星历失败,{ex.Message}");
            }
        }
    }
    public class X3DFGDOP接口
    {
        /// <summary>
        /// 主星星历x y z vx vy vz
        /// </summary>
        public double[] EphMain { get; set; }

        /// <summary>
        /// 邻星1星历x y z vx vy vz
        /// </summary>
        public double[] EphAdja1 { get; set; }

        /// <summary>
        /// 邻星2星历x y z vx vy vz
        /// </summary>
        public double[] EphAdja2 { get; set; }

        /// <summary>
        /// 采集时刻
        /// </summary>
        public DateTime CapTime { get; set; }

        /// <summary>
        /// 参考站位置经度
        /// </summary>
        public double RefLon { get; set; }

        /// <summary>
        /// 参考站位置纬度
        /// </summary>
        public double RefLat { get; set; }

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

        /// <summary>
        /// 星历位置误差(单位米)
        /// </summary>
        public double SatLocErr { get; set; } = 10000;

        /// <summary>
        ///星历速度误差
        /// </summary>
        public double EphVelErr { get; set; }

        /// <summary>
        /// 上行频点1(Hz)
        /// </summary>
        public double fu1 { get; set; }

        /// <summary>
        /// 上行频点2(Hz)
        /// </summary>
        public double fu2 { get; set; }

    }
}