X3DfoParamEditor.cs 17 KB

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