X2D1GDOPParam.cs 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240
  1. using DevExpress.XtraMap;
  2. using ExtensionsDev;
  3. using System;
  4. using System.Data;
  5. using System.Linq;
  6. using System.Collections.Generic;
  7. using DxHelper;
  8. using XdCxRhDW.Repostory;
  9. using XdCxRhDW.Entity;
  10. using XdCxRhDW.Api;
  11. using System.Drawing;
  12. using DevExpress.Utils.About;
  13. namespace XdCxRhDW.App.UserControl
  14. {
  15. public partial class X2D1GDOPParam : DevExpress.XtraEditors.XtraUserControl
  16. {
  17. public MapControl mapControl1;
  18. public GDOP星地两星一地接口 Model => new GDOP星地两星一地接口()
  19. {
  20. EphMain = ucEphXYZMain.EphParam(),
  21. EphAdja = ucEphXYZAdja.EphParam(),
  22. CapTime = txtCapTime.DateTime,
  23. StationLon = Convert.ToDouble(txtStationLocation1.Text.Replace(",", ",").Split(',')[0].Trim()),
  24. StationLat = Convert.ToDouble(txtStationLocation1.Text.Replace(",", ",").Split(',')[1].Trim()),
  25. RefLon = PosResType == EnumPosResType.X2D1NoRef ? 0 : Convert.ToDouble(txtRefLocation1.Text.Replace(",", ",").Split(',')[0].Trim()),
  26. RefLat = PosResType == EnumPosResType.X2D1NoRef ? 0 : Convert.ToDouble(txtRefLocation1.Text.Replace(",", ",").Split(',')[1].Trim()),
  27. DtousErr = Convert.ToDouble(txtDtousErr1.Text),
  28. SatLocErr = Convert.ToDouble(txtSatLocErr1.Text),
  29. };
  30. private EnumPosResType PosResType;
  31. public X2D1GDOPParam(PosRes item)
  32. {
  33. InitializeComponent();
  34. this.layoutControl1.UseDefault();
  35. txtCapTime.UseDefault();
  36. txtStationLocation1.UseDoubleClickToSelectAll();
  37. txtRefLocation1.UseDoubleClickToSelectAll();
  38. this.txtCapTime.DateTime = item.SigTime;
  39. this.txtDtousErr1.EditValue = 1;
  40. this.txtSatLocErr1.EditValue = 10000;
  41. PosResType = item.PosResType;
  42. if (PosResType == EnumPosResType.X2D1NoRef)
  43. {
  44. layoutControlItem14.Visibility = DevExpress.XtraLayout.Utils.LayoutVisibility.Never;
  45. }
  46. using (RHDWPartContext db = RHDWPartContext.GetContext(item.SigTime))
  47. {
  48. if (db.DatabaseExist)
  49. {
  50. var cg = db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefault();
  51. var station = db.StationRes.Where(m => m.ID == item.StationResID).FirstOrDefault();
  52. if (station != null)
  53. {
  54. this.txtStationLocation1.Text = $"{station.CdbTxLon},{station.CdbTxLat}";
  55. this.txtRefLocation1.Text = $"{station.RefLon},{station.RefLat}";
  56. }
  57. if (cg != null)
  58. {
  59. var mainEph = (cg.MainX, cg.MainY, cg.MainZ, cg.MainVx, cg.MainVy, cg.MainVz);
  60. ucEphXYZMain.SetParam($"主星", cg.MainCode, mainEph, Color.Black);
  61. var adjaEph = (cg.Adja1X, cg.Adja1Y, cg.Adja1Z, cg.Adja1Vx, cg.Adja1Vy, cg.Adja1Vz);
  62. ucEphXYZAdja.SetParam($"邻星", cg.Adja1Code, adjaEph, Color.Black);
  63. }
  64. }
  65. }
  66. }
  67. private (bool, string) ParamValidate()
  68. {
  69. var mainparam = ucEphXYZMain.ValidateParam();
  70. if (!mainparam.Item1)
  71. {
  72. return (false, mainparam.Item2);
  73. }
  74. var adjaparam = ucEphXYZAdja.ValidateParam();
  75. if (!adjaparam.Item1)
  76. {
  77. return (false, adjaparam.Item2);
  78. }
  79. var txtstat = txtStationLocation1.CheckLonLat("超短波");
  80. if (!txtstat.Item1)
  81. {
  82. return txtstat;
  83. }
  84. var refsta = txtRefLocation1.CheckLonLat("参考站");
  85. if (PosResType == EnumPosResType.X2D1 && !refsta.Item1)
  86. {
  87. return refsta;
  88. }
  89. return (true, "");
  90. }
  91. private void btnOK_Click(object sender, EventArgs e)
  92. {
  93. var pv = ParamValidate();
  94. if (!pv.Item1)
  95. {
  96. DxHelper.MsgBoxHelper.ShowWarning($"{pv.Item2}");
  97. return;
  98. }
  99. try
  100. {
  101. mapControl1.ClearMap();
  102. var cdb = new double[] { Model.StationLon, Model.StationLat, 0 };
  103. var refstation = new double[] { Model.RefLon, Model.RefLat, 0 };
  104. var data = GdopHelper.Gdop2Sat1DByXyz(Model.EphMain, Model.EphAdja, cdb
  105. , Model.DtousErr, Model.SatLocErr, PosResType == EnumPosResType.X2D1NoRef ? null : refstation);
  106. if (data == null)
  107. {
  108. return;
  109. }
  110. foreach (var errLins in data)//画GDOP
  111. {
  112. var mapDots = errLins.MapDots.Select(p => p).Select(p => (p.Lon, p.Lat));
  113. mapControl1.DrawGdopLineTwo(errLins.ErrDistanceKm, mapDots, 1);
  114. }
  115. }
  116. catch (Exception ex)
  117. {
  118. DxHelper.MsgBoxHelper.ShowError($"绘制{PosResType.GetEnumDisplayName()}GDOP失败,{ex.Message}");
  119. }
  120. }
  121. private void btnClose_Click(object sender, EventArgs e)
  122. {
  123. DxHelper.PopupHelper.HidePopup(this);
  124. }
  125. private async void btnEphCalc_Click(object sender, EventArgs e)
  126. {
  127. if (txtCapTime.DateTime == DateTime.MinValue)
  128. {
  129. DxHelper.MsgBoxHelper.ShowWarning("信号时间不能为空!");
  130. return;
  131. }
  132. var sigTime = txtCapTime.DateTime;
  133. try
  134. {
  135. var mainCode = ucEphXYZMain.GetSatCode();
  136. var adjaCode = ucEphXYZAdja.GetSatCode();
  137. var mainxlInfo = await XlRepository.GetLatestAsync(mainCode, sigTime);
  138. if (mainxlInfo == null)
  139. {
  140. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{mainCode}未找到对应的星历信息,请导入星历");
  141. return;
  142. }
  143. var maineph = EphHelper.Calc(mainxlInfo.TwoLine, sigTime);
  144. ucEphXYZMain.SetParam("主星", mainCode, (maineph.X, maineph.Y, maineph.Z, maineph.VX, maineph.VY, maineph.VZ), Color.Red);
  145. var adjaxlInfo = await XlRepository.GetLatestAsync(adjaCode, sigTime);
  146. if (adjaxlInfo == null)
  147. {
  148. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{adjaCode}未找到对应的星历信息,请导入星历");
  149. return;
  150. }
  151. var adjaeph = EphHelper.Calc(adjaxlInfo.TwoLine, sigTime);
  152. ucEphXYZAdja.SetParam("邻星", adjaCode, (adjaeph.X, adjaeph.Y, adjaeph.Z, adjaeph.VX, adjaeph.VY, adjaeph.VZ), Color.Red);
  153. }
  154. catch (Exception ex)
  155. {
  156. Serilog.Log.Error(ex, $"手动推算{PosResType.GetEnumDisplayName()}星历失败,SigTime={sigTime}");
  157. DxHelper.MsgBoxHelper.ShowError($"手动推算{PosResType.GetEnumDisplayName()}星历失败,{ex.Message}");
  158. }
  159. }
  160. }
  161. public class GDOP星地两星一地接口
  162. {
  163. /// <summary>
  164. /// 主星x y z vx vy vz
  165. /// </summary>
  166. public double[] EphMain { get; set; }
  167. /// <summary>
  168. /// 邻星x y z vx vy vz
  169. /// </summary>
  170. public double[] EphAdja { get; set; }
  171. /// <summary>
  172. /// 采集时刻
  173. /// </summary>
  174. public DateTime CapTime { get; set; }
  175. /// <summary>
  176. /// 超短接收站-经度
  177. /// </summary>
  178. public double StationLon { get; set; }
  179. /// <summary>
  180. /// 超短接收站-纬度
  181. /// </summary>
  182. public double StationLat { get; set; }
  183. /// <summary>
  184. /// 参考站位置经度
  185. /// </summary>
  186. public double RefLon { get; set; }
  187. /// <summary>
  188. /// 参考站位置纬度
  189. /// </summary>
  190. public double RefLat { get; set; }
  191. /// <summary>
  192. /// 时差误差(单位us)
  193. /// </summary>
  194. public double DtousErr { get; set; } = 1;
  195. /// <summary>
  196. /// 星历位置误差(单位米)
  197. /// </summary>
  198. public double SatLocErr { get; set; } = 10000;
  199. /// <summary>
  200. /// 定位类型
  201. /// </summary>
  202. public EnumPosResType PosResType { get; set; }
  203. }
  204. }