X3DfoParamEditor.cs 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436
  1. using DevExpress.XtraMap;
  2. using ExtensionsDev;
  3. using System;
  4. using System.Collections.Generic;
  5. using System.Data.Entity;
  6. using System.Drawing;
  7. using System.Linq;
  8. using XdCxRhDW.Api;
  9. using XdCxRhDW.Entity;
  10. using XdCxRhDW.Repostory;
  11. namespace XdCxRhDW.App.EditForms
  12. {
  13. public partial class X3DfoParamEditor : DevExpress.XtraEditors.XtraUserControl
  14. {
  15. private PosRes info;
  16. private CgRes cg;
  17. private MapControl mapControl1;
  18. private List<SatInfo> listSat;
  19. StationRes station;
  20. public X3DfoParamEditor(PosRes info, MapControl mapControl)
  21. {
  22. InitializeComponent();
  23. this.info = info;
  24. this.mapControl1 = mapControl;
  25. itemSigTime.Text = $"{itemSigTime.Text}({SysConfig.Config.TimeZoneUTC})";
  26. this.layoutControl1.UseDefault();
  27. sigTime.UseDefault();
  28. this.simpleLabelItem1.Text = $" ";
  29. }
  30. private async void X3DTOParamEditor_Load(object sender, EventArgs e)
  31. {
  32. using (RHDWContext db = new RHDWContext())
  33. {
  34. listSat = await db.SatInfos.ToListAsync();
  35. }
  36. using (RHDWPartContext db = RHDWPartContext.GetContext(info.SigTime))
  37. {
  38. cg = await db?.CgRes.Where(m => m.ID == info.CgResID).FirstOrDefaultAsync();
  39. station = await db?.StationRes.Where(m => m.ID == info.StationResID).FirstOrDefaultAsync();
  40. }
  41. if (cg != null)
  42. {
  43. this.txtDfo1.Text = $"{cg.Dfo1.Value}";
  44. this.txtDfo2.Text = $"{cg.Dfo2.Value}";
  45. this.txtYbDfo1.Text = $"{cg.YbMainDfo.Value}";
  46. this.txtYbDfo2.Text = $"{cg.YbAdja1Dfo.Value}";
  47. this.txtYbDfo3.Text = $"{cg.YbAdja2Dfo.Value}";
  48. this.sigTime.EditValue = info.SigTime;
  49. var mainEph = (cg.MainX, cg.MainY, cg.MainZ, cg.MainVx, cg.MainVy, cg.MainVz);
  50. ucEphXYZMain.SetParam($"主星", cg.MainCode, mainEph, Color.Black);
  51. var adja1Eph = (cg.Adja1X, cg.Adja1Y, cg.Adja1Z, cg.Adja1Vx, cg.Adja1Vy, cg.Adja1Vz);
  52. ucEphXYZAdja1.SetParam($"邻星1", cg.Adja1Code, adja1Eph, Color.Black);
  53. var adja2Eph = (cg.Adja2X, cg.Adja2Y, cg.Adja2Z, cg.Adja2Vx, cg.Adja2Vy, cg.Adja2Vz);
  54. ucEphXYZAdja2.SetParam($"邻星2", cg.Adja2Code, adja2Eph, Color.Black);
  55. this.txtTargetFreq.EditValue = cg.TarFreqUp.HasValue ? cg.TarFreqUp.Value * 1e-6 : 0;
  56. this.txtTargetDFreq.EditValue = cg.TarFreqDown.HasValue ? cg.TarFreqDown.Value * 1e-6 : 0;
  57. this.txtRefFreq.EditValue = cg.RefFreqUp.HasValue ? cg.RefFreqUp.Value * 1e-6 : 0;
  58. this.txtRefDFreq.EditValue = cg.RefFreqDown.HasValue ? cg.RefFreqDown.Value * 1e-6 : 0;
  59. this.txtDto1.Text = cg.Dto1?.ToString();
  60. this.txtDto2.Text = cg.Dto2?.ToString();
  61. this.txtYbDto1.Text = cg.YbMainDto?.ToString();
  62. this.txtYbDto2.Text = cg.YbAdja1Dto?.ToString();
  63. this.txtYbDto3.Text = cg.YbAdja2Dto?.ToString();
  64. }
  65. if (station != null)
  66. {
  67. this.txtsatStation.Text = $"{station.SatTxLon},{station.SatTxLat}";
  68. this.txtRefLocation.Text = $"{station.RefLon},{station.RefLat}";
  69. }
  70. if (info.PosResType == EnumPosResType.X3NoRef)
  71. {
  72. txtYbDfo1.Properties.ReadOnly = true;
  73. txtYbDfo2.Properties.ReadOnly = true;
  74. txtYbDfo3.Properties.ReadOnly = true;
  75. txtRefLocation.Properties.ReadOnly = true;
  76. this.txtRefLocation.Text = $"{0},{0}";
  77. }
  78. }
  79. public bool CheckDtoLineParam()
  80. {
  81. dxErrorProvider.ClearErrors();
  82. if (!txtsatStation.CheckLonLat(dxErrorProvider, "接收站"))
  83. {
  84. return false;
  85. }
  86. if (!txtRefLocation.CheckLonLat(dxErrorProvider, "参考站"))
  87. {
  88. return false;
  89. }
  90. if (!txtDto1.CheckDouble(dxErrorProvider, "主邻1时差"))
  91. {
  92. return false;
  93. }
  94. if (!txtDto2.CheckDouble(dxErrorProvider, "主邻2时差"))
  95. {
  96. return false;
  97. }
  98. if (!txtYbDto1.CheckDouble(dxErrorProvider, "样本主星时差"))
  99. {
  100. return false;
  101. }
  102. if (!txtYbDto2.CheckDouble(dxErrorProvider, "样本邻星1时差"))
  103. {
  104. return false;
  105. }
  106. if (!txtYbDto3.CheckDouble(dxErrorProvider, "样本邻星2时差"))
  107. {
  108. return false;
  109. }
  110. if (!ucEphXYZMain.CheckEphXYZ(dxErrorProvider))
  111. {
  112. return false;
  113. }
  114. if (!ucEphXYZAdja1.CheckEphXYZ(dxErrorProvider))
  115. {
  116. return false;
  117. }
  118. if (!ucEphXYZAdja2.CheckEphXYZ(dxErrorProvider))
  119. {
  120. return false;
  121. }
  122. return true;
  123. }
  124. public bool CheckPosParam()
  125. {
  126. dxErrorProvider.ClearErrors();
  127. if (!txtsatStation.CheckLonLat(dxErrorProvider, "接收站"))
  128. {
  129. return false;
  130. }
  131. if (!txtRefLocation.CheckLonLat(dxErrorProvider, "参考站"))
  132. {
  133. return false;
  134. }
  135. if (!txtDfo1.CheckDouble(dxErrorProvider, "主邻1频差"))
  136. {
  137. return false;
  138. }
  139. if (!txtDfo2.CheckDouble(dxErrorProvider, "主邻2频差"))
  140. {
  141. return false;
  142. }
  143. if (!txtYbDfo1.CheckDouble(dxErrorProvider, "样本主星频差"))
  144. {
  145. return false;
  146. }
  147. if (!txtYbDfo2.CheckDouble(dxErrorProvider, "样本邻星1频差"))
  148. {
  149. return false;
  150. }
  151. if (!txtYbDfo3.CheckDouble(dxErrorProvider, "样本邻星2频差"))
  152. {
  153. return false;
  154. }
  155. if (!txtTargetFreq.CheckDouble(dxErrorProvider, "目标上行频点"))
  156. {
  157. return false;
  158. }
  159. if (!txtTargetDFreq.CheckDouble(dxErrorProvider, "目标下行频点"))
  160. {
  161. return false;
  162. }
  163. if (!txtRefFreq.CheckDouble(dxErrorProvider, "参考上行频点"))
  164. {
  165. return false;
  166. }
  167. if (!txtRefDFreq.CheckDouble(dxErrorProvider, "参考下行频点"))
  168. {
  169. return false;
  170. }
  171. if (!ucEphXYZMain.CheckEph(dxErrorProvider))
  172. {
  173. return false;
  174. }
  175. if (!ucEphXYZAdja1.CheckEph(dxErrorProvider))
  176. {
  177. return false;
  178. }
  179. if (!ucEphXYZAdja2.CheckEph(dxErrorProvider))
  180. {
  181. return false;
  182. }
  183. return true;
  184. }
  185. private void btnOk_Click(object sender, EventArgs e)
  186. {
  187. if (!CheckPosParam()) { return; }
  188. try
  189. {
  190. var MsAnt = txtsatStation.GetLonLat();
  191. var RefGeod = txtRefLocation.GetLonLat();
  192. var sigTime = this.sigTime.DateTime;
  193. var DfoSx = Convert.ToDouble(this.txtDfo1.Text);
  194. var DfoSx1 = Convert.ToDouble(this.txtDfo2.Text);
  195. var YbMainDfo = Convert.ToDouble(this.txtYbDfo1.Text);
  196. var YbAdja1Dfo = Convert.ToDouble(this.txtYbDfo2.Text);
  197. var YbAdja2Dfo = Convert.ToDouble(this.txtYbDfo3.Text);
  198. var tFreq = Convert.ToDouble(this.txtTargetFreq.Text) * 1e6;
  199. var tdFreq = Convert.ToDouble(this.txtTargetDFreq.Text) * 1e6;
  200. var rFreq = Convert.ToDouble(this.txtRefFreq.Text) * 1e6;
  201. var rdFreq = Convert.ToDouble(this.txtRefDFreq.Text) * 1e6;
  202. var msEph = ucEphXYZMain.EphParam();
  203. var ns1Eph = ucEphXYZAdja1.EphParam();
  204. var ns2Eph = ucEphXYZAdja2.EphParam();
  205. var StationRes = new StationRes()
  206. {
  207. SatTxLon = MsAnt[0],
  208. SatTxLat = MsAnt[1],
  209. RefLon = RefGeod[0],
  210. RefLat = RefGeod[1],
  211. };
  212. var cgRes = new CgRes()
  213. {
  214. SigTime = sigTime,
  215. Dfo1 = DfoSx,
  216. Dfo2 = DfoSx1,
  217. YbMainDfo = YbMainDfo,
  218. YbAdja1Dfo = YbAdja1Dfo,
  219. YbAdja2Dfo = YbAdja2Dfo,
  220. TarFreqUp = tFreq,
  221. TarFreqDown = tdFreq,
  222. RefFreqUp = rFreq,
  223. RefFreqDown = rdFreq,
  224. MainX = msEph[0],
  225. MainY = msEph[1],
  226. MainZ = msEph[2],
  227. MainVx = msEph[3],
  228. MainVy = msEph[4],
  229. MainVz = msEph[5],
  230. Adja1X = ns1Eph[0],
  231. Adja1Y = ns1Eph[1],
  232. Adja1Z = ns1Eph[2],
  233. Adja1Vx = ns1Eph[3],
  234. Adja1Vy = ns1Eph[4],
  235. Adja1Vz = ns1Eph[5],
  236. Adja2X = ns2Eph[0],
  237. Adja2Y = ns2Eph[1],
  238. Adja2Z = ns2Eph[2],
  239. Adja2Vx = ns2Eph[3],
  240. Adja2Vy = ns2Eph[4],
  241. Adja2Vz = ns2Eph[5],
  242. };
  243. var res = PosApi.X3_PosTwoDfo(cgRes, StationRes);
  244. this.simpleLabelItem1.Text = $"{info.PosResType.GetEnumDisplayName()}定位点:[{res[0]:f4},{res[1]:f4}] 镜像点:[{res[3]:f4},{res[4]:f4}]";
  245. }
  246. catch (Exception ex)
  247. {
  248. Serilog.Log.Error(ex, $"{info.PosResType.GetEnumDisplayName()}手动定位失败.PosID={info.ID},SigTime={info.SigTime}");
  249. DxHelper.MsgBoxHelper.ShowWarning($"{info.PosResType.GetEnumDisplayName()}手动定位失败,{ex.Message}");
  250. }
  251. }
  252. private async void btnXl_Click(object sender, EventArgs e)
  253. {
  254. dxErrorProvider.ClearErrors();
  255. if (this.sigTime.DateTime == DateTime.MinValue)
  256. {
  257. dxErrorProvider.SetError(this.sigTime, "信号时间不能为空!");
  258. return;
  259. }
  260. var sigTime = this.sigTime.DateTime;
  261. try
  262. {
  263. var xlInfo = await XlRepository.GetLatestAsync(cg.MainCode.Value, sigTime);
  264. if (xlInfo == null)
  265. {
  266. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{cg.MainCode.Value}未找到对应的星历信息,请导入星历");
  267. return;
  268. }
  269. var xlInfo1 = await XlRepository.GetLatestAsync(cg.Adja1Code.Value, sigTime);
  270. if (xlInfo1 == null)
  271. {
  272. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{cg.Adja1Code.Value}未找到对应的星历信息,请导入星历");
  273. return;
  274. }
  275. var xlInfo2 = await XlRepository.GetLatestAsync(cg.Adja2Code.Value, sigTime);
  276. if (xlInfo2 == null)
  277. {
  278. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{cg.Adja2Code.Value}未找到对应的星历信息,请导入星历");
  279. return;
  280. }
  281. var mEph = EphHelper.Calc(xlInfo.TwoLine, sigTime.ToUtc());
  282. var nEph1 = EphHelper.Calc(xlInfo1.TwoLine, sigTime.ToUtc());
  283. var nEph2 = EphHelper.Calc(xlInfo2.TwoLine, sigTime.ToUtc());
  284. var mainEph = (mEph.X, mEph.Y, mEph.Z, mEph.VX, mEph.VY, mEph.VZ);
  285. ucEphXYZMain.SetParam($"主星", cg.MainCode, mainEph, Color.Red);
  286. var adja1Eph = (nEph1.X, nEph1.Y, nEph1.Z, nEph1.VX, nEph1.VY, nEph1.VZ);
  287. ucEphXYZAdja1.SetParam($"邻星1", cg.Adja1Code, adja1Eph, Color.Red);
  288. var adja2Eph = (nEph2.X, nEph2.Y, nEph2.Z, nEph2.VX, nEph2.VY, nEph2.VZ);
  289. ucEphXYZAdja2.SetParam($"邻星2", cg.Adja2Code, adja2Eph, Color.Red);
  290. }
  291. catch (Exception ex)
  292. {
  293. Serilog.Log.Error(ex, $"手动{info.PosResType.GetEnumDisplayName()}推算星历失败.PosID={info.ID},SigTime={info.SigTime}");
  294. DxHelper.MsgBoxHelper.ShowWarning($"手动{info.PosResType.GetEnumDisplayName()}推算星历失败,{ex.Message}");
  295. }
  296. }
  297. private void btnDtoCalc_Click(object sender, EventArgs e)
  298. {
  299. if (!CheckDtoLineParam()) { return; }
  300. try
  301. {
  302. var MsAnt = txtsatStation.GetLonLat();
  303. var RefGeod = txtRefLocation.GetLonLat();
  304. var DtoSx = Convert.ToDouble(this.txtDto1.Text);
  305. var DtoSx1 = Convert.ToDouble(this.txtDto2.Text);
  306. var YbMainDto = Convert.ToDouble(this.txtYbDto1.Text);
  307. var YbAdja1Dto = Convert.ToDouble(this.txtYbDto2.Text);
  308. var YbAdja2Dto = Convert.ToDouble(this.txtYbDto3.Text);
  309. double[] msEph = ucEphXYZMain.EphXYZ();
  310. double[] Ns1Eph = ucEphXYZAdja1.EphXYZ();
  311. double[] Ns2Eph = ucEphXYZAdja2.EphXYZ();
  312. DtoLineTwoStartOption twoStartOption = new DtoLineTwoStartOption();
  313. twoStartOption.MsEph = msEph;
  314. twoStartOption.NsEph = Ns1Eph;
  315. twoStartOption.MsAnt = MsAnt;
  316. twoStartOption.NsAnt = MsAnt;
  317. twoStartOption.RefGeod = RefGeod;
  318. twoStartOption.TargetDto = DtoSx;
  319. twoStartOption.RefDto = YbMainDto - YbAdja1Dto;
  320. twoStartOption.PosLon = info.PosLon;
  321. twoStartOption.PosLat = info.PosLat;
  322. var msat = listSat.FirstOrDefault(m => m.SatCode == cg.MainCode.Value)?.Sat;
  323. if (string.IsNullOrWhiteSpace(msat)) msat = cg.MainCode.Value.ToString();
  324. var nsat = listSat.FirstOrDefault(m => m.SatCode == cg.Adja1Code.Value)?.Sat;
  325. if (string.IsNullOrWhiteSpace(nsat)) nsat = cg.Adja1Code.Value.ToString();
  326. var ad2sat = listSat.FirstOrDefault(m => m.SatCode == cg.Adja2Code.Value)?.Sat;
  327. if (string.IsNullOrWhiteSpace(ad2sat)) ad2sat = cg.Adja2Code.Value.ToString();
  328. var tsDtoLine = DrawDtoLineHelper.DtoLine2XStart(twoStartOption);
  329. mapControl1.DrawDtoLine($"[{msat},{nsat}]带参时差线", tsDtoLine);
  330. twoStartOption.NsEph = Ns2Eph;
  331. twoStartOption.RefDto = YbMainDto - YbAdja2Dto;
  332. twoStartOption.TargetDto = DtoSx1;
  333. var tsDtoLine1 = DrawDtoLineHelper.DtoLine2XStart(twoStartOption);
  334. mapControl1.DrawDtoLine($"[{msat},{ad2sat}]带参时差线", tsDtoLine1);
  335. }
  336. catch (Exception ex)
  337. {
  338. Serilog.Log.Error(ex, $"绘制{info.PosResType.GetEnumDisplayName()}时差线失败.PosID={info.ID},SigTime={info.SigTime}");
  339. DxHelper.MsgBoxHelper.ShowWarning($"绘制{info.PosResType.GetEnumDisplayName()}时差线失败,{ex.Message}");
  340. }
  341. }
  342. private void btnDfoCalc_Click(object sender, EventArgs e)
  343. {
  344. if (!CheckPosParam()) { return; }
  345. try
  346. {
  347. var MsAnt = txtsatStation.GetLonLat();
  348. var RefGeod = txtRefLocation.GetLonLat();
  349. var sigTime = this.sigTime.DateTime;
  350. var DfoSx = Convert.ToDouble(this.txtDfo1.Text);
  351. var DfoSx1 = Convert.ToDouble(this.txtDfo2.Text);
  352. var YbMainDfo = Convert.ToDouble(this.txtYbDfo1.Text);
  353. var YbAdja1Dfo = Convert.ToDouble(this.txtYbDfo2.Text);
  354. var YbAdja2Dfo = Convert.ToDouble(this.txtYbDfo3.Text);
  355. var tFreq = Convert.ToDouble(this.txtTargetFreq.Text) * 1e6;
  356. var tdFreq = Convert.ToDouble(this.txtTargetDFreq.Text) * 1e6;
  357. var rFreq = Convert.ToDouble(this.txtRefFreq.Text) * 1e6;
  358. var rdFreq = Convert.ToDouble(this.txtRefDFreq.Text) * 1e6;
  359. var msEph = ucEphXYZMain.EphParam();
  360. var ns1Eph = ucEphXYZAdja1.EphParam();
  361. var ns2Eph = ucEphXYZAdja2.EphParam();
  362. DfoLineTwoStartOption twoStartOption = new DfoLineTwoStartOption();
  363. twoStartOption.Freq = tFreq;
  364. twoStartOption.RefFreq = rFreq;
  365. twoStartOption.MsEph = msEph;
  366. twoStartOption.NsEph = ns1Eph;
  367. twoStartOption.MsAnt = MsAnt;
  368. twoStartOption.NsAnt = MsAnt;
  369. twoStartOption.RefGeod = RefGeod;
  370. twoStartOption.TargetDfo = DfoSx;
  371. twoStartOption.Turn1 = Math.Abs(twoStartOption.Freq - tdFreq);
  372. twoStartOption.Turn2 = Math.Abs(twoStartOption.RefFreq - rdFreq);
  373. twoStartOption.RefDfo = YbMainDfo - YbAdja1Dfo;
  374. var tsDtoLine = DrawDfoLineHelper.DfoLineTwoStart(twoStartOption);
  375. var msat = listSat?.FirstOrDefault(m => m.SatCode == cg.MainCode.Value)?.Sat; ;
  376. var ad1sat = listSat?.FirstOrDefault(m => m.SatCode == cg.Adja1Code.Value)?.Sat;
  377. if (msat == null) msat = cg.MainCode.ToString();
  378. if (ad1sat == null) ad1sat = cg.Adja1Code.ToString();
  379. mapControl1.DrawDtoLine($"{info.PosResType.GetEnumDisplayName()}[{msat},{ad1sat}]频差线", tsDtoLine);
  380. twoStartOption.NsEph = ns2Eph;
  381. twoStartOption.TargetDfo = DfoSx1;
  382. twoStartOption.RefDfo = YbMainDfo - YbAdja2Dfo;
  383. var tsDtoLine1 = DrawDfoLineHelper.DfoLineTwoStart(twoStartOption);
  384. string ad2sat = string.Empty;
  385. if (cg.Adja2Code.HasValue)
  386. {
  387. ad2sat = listSat.FirstOrDefault(m => m.SatCode == cg.Adja2Code.Value)?.Sat;
  388. }
  389. mapControl1.DrawDtoLine($"{info.PosResType.GetEnumDisplayName()}[{msat},{ad2sat}]频差线", tsDtoLine1);
  390. }
  391. catch (Exception ex)
  392. {
  393. Serilog.Log.Error(ex, $"绘制{info.PosResType.GetEnumDisplayName()}频差线失败.PosID={info.ID},SigTime={sigTime}");
  394. DxHelper.MsgBoxHelper.ShowError($"绘制{info.PosResType.GetEnumDisplayName()}频差线失败,{ex.Message}");
  395. }
  396. }
  397. }
  398. }