XdCxRhDW/XdCxRhDW.App/UserControl/X2D1GDOPParam.cs

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

namespace XdCxRhDW.App.UserControl
{
    public partial class X2D1GDOPParam : DevExpress.XtraEditors.XtraUserControl
    {
        public MapControl mapControl1;
        public GDOP星地两星一地接口 Model => new GDOP星地两星一地接口()
        {
            EphMain = ucEphXYZMain.EphParam(),
            EphAdja = ucEphXYZAdja.EphParam(),
            CapTime = txtCapTime.DateTime,
            CDBStation = txtStationLocation1.GetLonLat(),
            RefStation = PosResType == EnumPosResType.X2D1NoRef ? new double[3] { 0, 0, 0 } : txtRefLocation1.GetLonLat(),
            DtousErr = Convert.ToDouble(txtDtousErr1.Text),
            SatLocErr = Convert.ToDouble(txtSatLocErr1.Text),
        };

        private EnumPosResType PosResType;
        public X2D1GDOPParam(PosRes item)
        {
            InitializeComponent();
            this.layoutControl1.UseDefault();
            txtCapTime.UseDefault();
            txtStationLocation1.UseDoubleClickToSelectAll();
            txtRefLocation1.UseDoubleClickToSelectAll();
            this.txtCapTime.DateTime = item.SigTime;
            this.txtDtousErr1.EditValue = 1;
            this.txtSatLocErr1.EditValue = 10000;
            PosResType = item.PosResType;
            if (PosResType == EnumPosResType.X2D1NoRef)
            {
                layoutControlItem14.Visibility = DevExpress.XtraLayout.Utils.LayoutVisibility.Never;
            }

            using (RHDWPartContext db = RHDWPartContext.GetContext(item.SigTime))
            {
                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.txtStationLocation1.Text = $"{station.CdbTxLon},{station.CdbTxLat}";
                    this.txtRefLocation1.Text = $"{station.RefLon},{station.RefLat}";
                }

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

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

                }
            }

        }


        private bool ParamValidate()
        {
            dxErrorProvider.ClearErrors();
            if (!ucEphXYZMain.CheckEph(dxErrorProvider))
            {
                return false;
            }
            if (!ucEphXYZAdja.CheckEph(dxErrorProvider))
            {
                return false;
            }
            if (!txtStationLocation1.CheckLonLat(dxErrorProvider, "超短波"))
            {
                return false;
            }
            if (PosResType == EnumPosResType.X2D1&&!txtRefLocation1.CheckLonLat(dxErrorProvider, "参考站"))
            {
                return false;
            }
            if (!txtDtousErr1.CheckDouble(dxErrorProvider, "时差误差"))
            {
                return false;
            }
            if (!txtSatLocErr1.CheckDouble(dxErrorProvider, "星历位置误差"))
            {
                return false;
            }
            return true;
        }

        private void btnOK_Click(object sender, EventArgs e)
        {
            if (!ParamValidate()) { return; }
            try
            {

                mapControl1.ClearMap();
                var data = GdopHelper.Gdop2Sat1DByXyz(Model.EphMain, Model.EphAdja, Model.CDBStation
                         , Model.DtousErr, Model.SatLocErr, PosResType == EnumPosResType.X2D1NoRef ? null : Model.RefStation);
                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, 1);
                }
            }
            catch (Exception ex)
            {
                DxHelper.MsgBoxHelper.ShowError($"绘制{PosResType.GetEnumDisplayName()}GDOP失败,{ex.Message}");
            }
        }
        private void btnClose_Click(object sender, EventArgs e)
        {
            DxHelper.PopupHelper.HidePopup(this);
        }
        private async void btnEphCalc_Click(object sender, EventArgs e)
        {
            dxErrorProvider.ClearErrors();
            if (txtCapTime.DateTime == DateTime.MinValue)
            {
                DxHelper.MsgBoxHelper.ShowWarning("信号时间不能为空!");
                return;
            }
            var sigTime = txtCapTime.DateTime;
            try
            {
                var mainCode = ucEphXYZMain.GetSatCode();
                var adjaCode = ucEphXYZAdja.GetSatCode();

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

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



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

                ucEphXYZAdja.SetParam("邻星", adjaCode, (adjaeph.X, adjaeph.Y, adjaeph.Z, adjaeph.VX, adjaeph.VY, adjaeph.VZ), Color.Red);
            }
            catch (Exception ex)
            {
                Serilog.Log.Error(ex, $"手动推算{PosResType.GetEnumDisplayName()}星历失败,SigTime={sigTime}");
                DxHelper.MsgBoxHelper.ShowError($"手动推算{PosResType.GetEnumDisplayName()}星历失败,{ex.Message}");
            }


        }
    }
    public class GDOP星地两星一地接口
    {
        /// <summary>
        /// 主星x y z vx vy vz
        /// </summary>
        public double[] EphMain { get; set; }

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

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

        /// <summary>
        /// 超短接收站-经度 纬度 高度
        /// </summary>
        public double[] CDBStation { get; set; }

        /// <summary>
        /// 参考站位置-经度 纬度 高度
        /// </summary>
        public double[] RefStation { get; set; }

        /// <summary>
        /// 时差误差(单位us)
        /// </summary>
        public double DtousErr { get; set; } = 1;

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

        /// <summary>
        /// 定位类型
        /// </summary>
        public EnumPosResType PosResType { get; set; }

    }
}