X3DTOParamEditor.cs 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321
  1. using DevExpress.XtraMap;
  2. using DxHelper;
  3. using ExtensionsDev;
  4. using System;
  5. using System.CodeDom;
  6. using System.Collections.Generic;
  7. using System.ComponentModel;
  8. using System.Data;
  9. using System.Data.Entity;
  10. using System.Drawing;
  11. using System.Linq;
  12. using System.Text;
  13. using System.Threading.Tasks;
  14. using XdCxRhDW.Api;
  15. using XdCxRhDW.Entity;
  16. using XdCxRhDW.Repostory;
  17. namespace XdCxRhDW.App.EditForms
  18. {
  19. public partial class X3DTOParamEditor : DevExpress.XtraEditors.XtraUserControl
  20. {
  21. private MapControl mapControl1;
  22. private PosRes info;
  23. private CgRes cg;
  24. private List<SatInfo> listSat;
  25. public X3DTOParamEditor(PosRes info, MapControl mapControl)
  26. {
  27. InitializeComponent();
  28. this.info = info;
  29. itemSigTime.Text = $"{itemSigTime.Text}({SysConfig.Config.TimeZoneUTC})";
  30. this.layoutControl1.UseDefault();
  31. sigTime.UseDefault();
  32. this.Text = $"{info.PosResType.GetEnumDisplayName()}时差参数";
  33. this.mapControl1 = mapControl;
  34. txtsatStation.EditValueChanged += TxtsatStation_EditValueChanged;
  35. txtRefLocation.EditValueChanged += TxtRefLocation_EditValueChanged;
  36. }
  37. private void TxtRefLocation_EditValueChanged(object sender, EventArgs e)
  38. {
  39. txtRefLocation.CheckLonLat(dxErrorProvider, "参考站");
  40. }
  41. private void TxtsatStation_EditValueChanged(object sender, EventArgs e)
  42. {
  43. txtsatStation.CheckLonLat(dxErrorProvider, "接收站");
  44. }
  45. private async void X3DTOParamEditor_Load(object sender, EventArgs e)
  46. {
  47. StationRes station = null;
  48. using (RHDWContext db = new RHDWContext())
  49. {
  50. listSat = await db.SatInfos.ToListAsync();
  51. }
  52. using (RHDWPartContext db = RHDWPartContext.GetContext(info.SigTime))
  53. {
  54. cg = await db?.CgRes.Where(m => m.ID == info.CgResID).FirstOrDefaultAsync();
  55. station = await db?.StationRes.Where(m => m.ID == info.StationResID).FirstOrDefaultAsync();
  56. }
  57. if (cg != null)
  58. {
  59. this.txtDtoSx.Text = $"{cg.Dto1.Value}";
  60. this.txtDtoSx1.Text = $"{cg.Dto2.Value}";
  61. if (info.PosResType == EnumPosResType.X3)
  62. {
  63. this.txtYbMain.Text = $"{cg.YbMainDto.Value}";
  64. this.txtYbAdja.Text = $"{cg.YbAdja1Dto.Value}";
  65. this.txtYbAdja1.Text = $"{cg.YbAdja2Dto.Value}";
  66. }
  67. this.sigTime.EditValue = info.SigTime;
  68. var mainEph = (cg.MainX, cg.MainY, cg.MainZ);
  69. ucEphXYZMain.SetXYZ($"主星", cg.MainCode, mainEph, Color.Black);
  70. var adja1Eph = (cg.Adja1X, cg.Adja1Y, cg.Adja1Z);
  71. ucEphXYZAdja1.SetXYZ($"邻星1", cg.Adja1Code, adja1Eph, Color.Black);
  72. var adja2Eph = (cg.Adja2X, cg.Adja2Y, cg.Adja2Z);
  73. ucEphXYZAdja2.SetXYZ($"邻星2", cg.Adja2Code, adja2Eph, Color.Black);
  74. }
  75. if (station != null)
  76. {
  77. this.txtsatStation.Text = $"{station.SatTxLon},{station.SatTxLat}";
  78. this.txtRefLocation.Text = $"{station.RefLon},{station.RefLat}";
  79. }
  80. if (info.PosResType == EnumPosResType.X3NoRef)
  81. {
  82. txtYbMain.Properties.ReadOnly = true;
  83. txtYbAdja.Properties.ReadOnly = true;
  84. txtYbAdja1.Properties.ReadOnly = true;
  85. txtRefLocation.Properties.ReadOnly = true;
  86. this.txtRefLocation.Text = $"{0},{0}";
  87. }
  88. }
  89. public bool CheckParam()
  90. {
  91. dxErrorProvider.ClearErrors();
  92. if (!txtsatStation.CheckLonLat(dxErrorProvider, "接收站"))
  93. {
  94. return false;
  95. }
  96. if (info.PosResType == EnumPosResType.X3 && !txtRefLocation.CheckLonLat(dxErrorProvider, "参考站"))
  97. {
  98. return false;
  99. }
  100. if (!txtDtoSx.CheckDouble(dxErrorProvider, "主邻1时差"))
  101. {
  102. return false;
  103. }
  104. if (!txtDtoSx1.CheckDouble(dxErrorProvider, "主邻2时差"))
  105. {
  106. return false;
  107. }
  108. if (info.PosResType == EnumPosResType.X3 && !txtYbMain.CheckDouble(dxErrorProvider, "样本主星时差"))
  109. {
  110. return false;
  111. }
  112. if (info.PosResType == EnumPosResType.X3 && !txtYbAdja.CheckDouble(dxErrorProvider, "样本邻星1时差"))
  113. {
  114. return false;
  115. }
  116. if (info.PosResType == EnumPosResType.X3 && !txtYbAdja1.CheckDouble(dxErrorProvider, "样本邻星2时差"))
  117. {
  118. return false;
  119. }
  120. if (!ucEphXYZMain.CheckEphXYZ(dxErrorProvider))
  121. {
  122. return false;
  123. }
  124. if (!ucEphXYZAdja1.CheckEphXYZ(dxErrorProvider))
  125. {
  126. return false;
  127. }
  128. if (!ucEphXYZAdja2.CheckEphXYZ(dxErrorProvider))
  129. {
  130. return false;
  131. }
  132. return true;
  133. }
  134. private void btnDtoLine_Click(object sender, EventArgs e)
  135. {
  136. if (!CheckParam()) { return; }
  137. try
  138. {
  139. var MsAnt = txtsatStation.GetLonLat();
  140. var RefGeod = info.PosResType == EnumPosResType.X3 ? txtRefLocation.GetLonLat() : new double[3] { 0, 0, 0 };
  141. var DtoSx = Convert.ToDouble(this.txtDtoSx.Text);
  142. var DtoSx1 = Convert.ToDouble(this.txtDtoSx1.Text);
  143. var YbMainDto = info.PosResType == EnumPosResType.X3 ? Convert.ToDouble(this.txtYbMain.Text) : 0;
  144. var YbAdja1Dto = info.PosResType == EnumPosResType.X3 ? Convert.ToDouble(this.txtYbAdja.Text) : 0;
  145. var YbAdja2Dto = info.PosResType == EnumPosResType.X3 ? Convert.ToDouble(this.txtYbAdja1.Text) : 0;
  146. double[] msEph = ucEphXYZMain.EphXYZ();
  147. double[] Ns1Eph = ucEphXYZAdja1.EphXYZ();
  148. double[] Ns2Eph = ucEphXYZAdja2.EphXYZ();
  149. DtoLineTwoStartOption twoStartOption = new DtoLineTwoStartOption();
  150. twoStartOption.MsEph = msEph;
  151. twoStartOption.NsEph = Ns1Eph;
  152. twoStartOption.MsAnt = MsAnt;
  153. twoStartOption.NsAnt = MsAnt;
  154. twoStartOption.RefGeod = RefGeod;
  155. twoStartOption.TargetDto = DtoSx;
  156. twoStartOption.RefDto = YbMainDto - YbAdja1Dto;
  157. twoStartOption.PosLon = info.PosLon;
  158. twoStartOption.PosLat = info.PosLat;
  159. var msat = listSat.FirstOrDefault(m => m.SatCode == cg.MainCode.Value)?.Sat;
  160. if (string.IsNullOrWhiteSpace(msat)) msat = cg.MainCode.Value.ToString();
  161. var nsat = listSat.FirstOrDefault(m => m.SatCode == cg.Adja1Code.Value)?.Sat;
  162. if (string.IsNullOrWhiteSpace(nsat)) nsat = cg.Adja1Code.Value.ToString();
  163. var ad2sat = listSat.FirstOrDefault(m => m.SatCode == cg.Adja2Code.Value)?.Sat;
  164. if (string.IsNullOrWhiteSpace(ad2sat)) ad2sat = cg.Adja2Code.Value.ToString();
  165. if (info.PosResType == EnumPosResType.X3)
  166. {
  167. var tsDtoLine = DrawDtoLineHelper.DtoLine2XStart(twoStartOption);
  168. mapControl1.DrawDtoLine($"[{msat},{nsat}]带参时差线", tsDtoLine);
  169. twoStartOption.NsEph = Ns2Eph;
  170. twoStartOption.RefDto = YbMainDto - YbAdja2Dto;
  171. twoStartOption.TargetDto = DtoSx1;
  172. var tsDtoLine1 = DrawDtoLineHelper.DtoLine2XStart(twoStartOption);
  173. mapControl1.DrawDtoLine($"[{msat},{ad2sat}]带参时差线", tsDtoLine1);
  174. }
  175. else
  176. {
  177. var tsDtoLine = DrawDtoLineHelper.DtoLine2XNoRefStart(twoStartOption);
  178. mapControl1.DrawDtoLine($"[{msat},{nsat}]无参时差线", tsDtoLine);
  179. twoStartOption.NsEph = Ns2Eph;
  180. twoStartOption.TargetDto = DtoSx1;
  181. var tsDtoLine1 = DrawDtoLineHelper.DtoLine2XNoRefStart(twoStartOption);
  182. mapControl1.DrawDtoLine($"[{msat},{ad2sat}]无参时差线", tsDtoLine1);
  183. }
  184. }
  185. catch (Exception ex)
  186. {
  187. Serilog.Log.Error(ex, $"绘制{info.PosResType.GetEnumDisplayName()}时差线失败.PosID={info.ID},SigTime={info.SigTime}");
  188. DxHelper.MsgBoxHelper.ShowWarning($"绘制{info.PosResType.GetEnumDisplayName()}时差线失败,{ex.Message}");
  189. }
  190. }
  191. private async void btnEphCalc_Click(object sender, EventArgs e)
  192. {
  193. dxErrorProvider.ClearErrors();
  194. if (this.sigTime.DateTime == DateTime.MinValue)
  195. {
  196. DxHelper.MsgBoxHelper.ShowWarning("信号时间不能为空!");
  197. return;
  198. }
  199. var sigTime = this.sigTime.DateTime;
  200. try
  201. {
  202. var xlInfo = await XlRepository.GetLatestAsync(cg.MainCode.Value, sigTime);
  203. if (xlInfo == null)
  204. {
  205. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{cg.MainCode.Value}未找到对应的星历信息,请导入星历");
  206. return;
  207. }
  208. var xlInfo1 = await XlRepository.GetLatestAsync(cg.Adja1Code.Value, sigTime);
  209. if (xlInfo1 == null)
  210. {
  211. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{cg.Adja1Code.Value}未找到对应的星历信息,请导入星历");
  212. return;
  213. }
  214. var xlInfo2 = await XlRepository.GetLatestAsync(cg.Adja2Code.Value, sigTime);
  215. if (xlInfo2 == null)
  216. {
  217. DxHelper.MsgBoxHelper.ShowWarning($"卫星:{cg.Adja2Code.Value}未找到对应的星历信息,请导入星历");
  218. return;
  219. }
  220. var mEph = EphHelper.Calc(xlInfo.TwoLine, sigTime.ToUtc());
  221. var nEph1 = EphHelper.Calc(xlInfo1.TwoLine, sigTime.ToUtc());
  222. var nEph2 = EphHelper.Calc(xlInfo2.TwoLine, sigTime.ToUtc());
  223. var mainEph = (mEph.X, mEph.Y, mEph.Z);
  224. ucEphXYZMain.SetXYZ($"主星", cg.MainCode, mainEph, Color.Red);
  225. var adja1Eph = (nEph1.X, nEph1.Y, nEph1.Z);
  226. ucEphXYZAdja1.SetXYZ($"邻星1", cg.Adja1Code, adja1Eph, Color.Red);
  227. var adja2Eph = (nEph2.X, nEph2.Y, nEph2.Z);
  228. ucEphXYZAdja2.SetXYZ($"邻星2", cg.Adja2Code, adja2Eph, Color.Red);
  229. }
  230. catch (Exception ex)
  231. {
  232. Serilog.Log.Error(ex, $"手动{info.PosResType.GetEnumDisplayName()}推算星历失败.PosID={info.ID},SigTime={info.SigTime}");
  233. DxHelper.MsgBoxHelper.ShowWarning($"手动{info.PosResType.GetEnumDisplayName()}推算星历失败,{ex.Message}");
  234. }
  235. }
  236. private void btnPos_Click(object sender, EventArgs e)
  237. {
  238. if (!CheckParam()) { return; }
  239. try
  240. {
  241. var MsAnt = txtsatStation.GetLonLat();
  242. var RefGeod = info.PosResType == EnumPosResType.X3 ? txtRefLocation.GetLonLat() : new double[3] { 0, 0, 0 };
  243. var sigTime = this.sigTime.DateTime;
  244. var DtoSx = Convert.ToDouble(this.txtDtoSx.Text);
  245. var DtoSx1 = Convert.ToDouble(this.txtDtoSx1.Text);
  246. var YbMainDto = info.PosResType == EnumPosResType.X3 ? Convert.ToDouble(this.txtYbMain.Text) : 0;
  247. var YbAdja1Dto = info.PosResType == EnumPosResType.X3 ? Convert.ToDouble(this.txtYbAdja.Text) : 0;
  248. var YbAdja2Dto = info.PosResType == EnumPosResType.X3 ? Convert.ToDouble(this.txtYbAdja1.Text) : 0;
  249. double[] msEph = ucEphXYZMain.EphXYZ();
  250. double[] Ns1Eph = ucEphXYZAdja1.EphXYZ();
  251. double[] Ns2Eph = ucEphXYZAdja2.EphXYZ();
  252. var StationRes = new StationRes()
  253. {
  254. SatTxLon = MsAnt[0],
  255. SatTxLat = MsAnt[1],
  256. RefLon = RefGeod[0],
  257. RefLat = RefGeod[1],
  258. };
  259. var cgRes = new CgRes()
  260. {
  261. SigTime = sigTime,
  262. Dto1 = DtoSx,
  263. Dto2 = DtoSx1,
  264. YbMainDto = YbMainDto,
  265. YbAdja1Dto = YbAdja1Dto,
  266. YbAdja2Dto = YbAdja2Dto,
  267. MainX = msEph[0],
  268. MainY = msEph[1],
  269. MainZ = msEph[2],
  270. Adja1X = Ns1Eph[0],
  271. Adja1Y = Ns1Eph[1],
  272. Adja1Z = Ns1Eph[2],
  273. Adja2X = Ns2Eph[0],
  274. Adja2Y = Ns2Eph[1],
  275. Adja2Z = Ns2Eph[2],
  276. };
  277. var res = info.PosResType == EnumPosResType.X3 ? PosApi.X3_Pos(cgRes, StationRes) : PosApi.X3_PosNoRef(cgRes, StationRes);
  278. this.txtPosRes.Text = $"{info.PosResType.GetEnumDisplayName()}定位点:[{res[0]:f4},{res[1]:f4}] 镜像点:[{res[3]:f4},{res[4]:f4}]";
  279. }
  280. catch (Exception ex)
  281. {
  282. Serilog.Log.Error(ex, $"{info.PosResType.GetEnumDisplayName()}手动定位失败.PosID={info.ID},SigTime={info.SigTime}");
  283. DxHelper.MsgBoxHelper.ShowWarning($"{info.PosResType.GetEnumDisplayName()}手动定位失败,{ex.Message}");
  284. }
  285. }
  286. }
  287. }