123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240 |
- 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;
- 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,
- StationLon = Convert.ToDouble(txtStationLocation1.Text.Replace(",", ",").Split(',')[0].Trim()),
- StationLat = Convert.ToDouble(txtStationLocation1.Text.Replace(",", ",").Split(',')[1].Trim()),
- RefLon = PosResType == EnumPosResType.X2D1NoRef ? 0 : Convert.ToDouble(txtRefLocation1.Text.Replace(",", ",").Split(',')[0].Trim()),
- RefLat = PosResType == EnumPosResType.X2D1NoRef ? 0 : Convert.ToDouble(txtRefLocation1.Text.Replace(",", ",").Split(',')[1].Trim()),
- 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))
- {
- 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.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, string) ParamValidate()
- {
- var mainparam = ucEphXYZMain.ValidateParam();
- if (!mainparam.Item1)
- {
- return (false, mainparam.Item2);
- }
- var adjaparam = ucEphXYZAdja.ValidateParam();
- if (!adjaparam.Item1)
- {
- return (false, adjaparam.Item2);
- }
-
- var txtstat = txtStationLocation1.CheckLonLat("超短波");
- if (!txtstat.Item1)
- {
- return txtstat;
- }
- var refsta = txtRefLocation1.CheckLonLat("参考站");
- if (PosResType == EnumPosResType.X2D1 && !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 cdb = new double[] { Model.StationLon, Model.StationLat, 0 };
- var refstation = new double[] { Model.RefLon, Model.RefLat, 0 };
- var data = GdopHelper.Gdop2Sat1DByXyz(Model.EphMain, Model.EphAdja, cdb
- , Model.DtousErr, Model.SatLocErr, PosResType == EnumPosResType.X2D1NoRef ? null : 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)
- {
- 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);
- 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);
- 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 StationLon { get; set; }
- /// <summary>
- /// 超短接收站-纬度
- /// </summary>
- public double StationLat { get; set; }
- /// <summary>
- /// 参考站位置经度
- /// </summary>
- public double RefLon { get; set; }
- /// <summary>
- /// 参考站位置纬度
- /// </summary>
- public double RefLat { 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; }
- }
- }
|