CtrlPosXd.cs 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463
  1. using DevExpress.Utils.Drawing.Helpers;
  2. using DevExpress.Utils.Extensions;
  3. using DevExpress.XtraEditors;
  4. using DevExpress.XtraExport.Helpers;
  5. using DevExpress.XtraGrid.Views.Grid;
  6. using DevExpress.XtraMap;
  7. using DevExpress.XtraTreeList.Data;
  8. using DxHelper;
  9. using System;
  10. using System.Collections.Generic;
  11. using System.ComponentModel;
  12. using System.Data;
  13. using System.Data.Entity;
  14. using System.Drawing;
  15. using System.IO;
  16. using System.Linq;
  17. using System.Text;
  18. using System.Threading;
  19. using System.Threading.Tasks;
  20. using System.Windows.Controls;
  21. using System.Windows.Documents;
  22. using System.Windows.Forms;
  23. using XdCxRhDW.App.Api.时差粗值预测;
  24. using XdCxRhDW.App.Api.时差线;
  25. using XdCxRhDW.App.Api.星历推算;
  26. using XdCxRhDW.App.DTO;
  27. using XdCxRhDW.App.UserControl;
  28. using XzXdDw.App.Api;
  29. using XzXdDw.App.Api.星地GDOP误差椭圆;
  30. using XzXdDw.App.EditForms;
  31. using XzXdDw.App.EFContext;
  32. using XzXdDw.App.Model;
  33. namespace XzXdDw.App.UserControl
  34. {
  35. /// <summary>
  36. /// 星地定位
  37. /// </summary>
  38. public partial class CtrlPosXd : DevExpress.XtraEditors.XtraUserControl
  39. {
  40. DtXDParam dtxdctrl = null;
  41. TcpServer tcpServer;
  42. public CtrlPosXd()
  43. {
  44. InitializeComponent();
  45. tcpServer = new TcpServer();
  46. }
  47. private async void CtrlXdPos_Load(object sender, EventArgs e)
  48. {
  49. try
  50. {
  51. gridPos.Init().UseMultiSelect().UseFilter().UseRowNumber().UseExportXlsx()
  52. .AddMenu("删除", SvgHelper.CreateClose(), async () =>
  53. {
  54. try
  55. {
  56. if (XtraMessageBox.Show("确认删除?(Ctrl+A可全选删除)", "确认", MessageBoxButtons.YesNo, MessageBoxIcon.Question) != DialogResult.Yes)
  57. {
  58. return;
  59. }
  60. var ids = gridView1.GetSelectedRows();
  61. List<XDPosRes> deletePos = new List<XDPosRes>();
  62. using (RHDWContext db = new RHDWContext())
  63. {
  64. foreach (var id in ids)
  65. {
  66. var item = gridView1.GetRow(id) as XDPosRes;
  67. var delItem = await db.XDPosRes.Where(p => p.ID == item.ID).FirstOrDefaultAsync();
  68. if (delItem != null)
  69. {
  70. db.XDPosRes.Remove(delItem);
  71. }
  72. deletePos.Add(item);
  73. }
  74. await db.SaveChangesAsync();
  75. }
  76. gridView1.DeleteSelectedRows();
  77. mapControl1.DelPosItem(deletePos);
  78. }
  79. catch (Exception ex)
  80. {
  81. Serilog.Log.Error("删除结果失败", ex);
  82. XtraMessageBox.Show("删除结果失败");
  83. }
  84. })
  85. .AddMenu("手动定位", SvgHelper.LoadFromFile("Image\\Pos.svg"), XdPos)
  86. .AddMenu("绘制时差线", SvgHelper.LoadFromFile("Image\\DrawLine.svg"), DrawDtoLine)
  87. .AddMenu("加载仿真数据", SvgHelper.LoadFromFile("Image\\LoadData.svg"), LoadSimulationData)
  88. .AddMenu("GDOP分析", SvgHelper.LoadFromFile("Image\\GDOP.svg"), () =>
  89. {
  90. var ids = gridView1.GetSelectedRows();
  91. if (ids.Length <= 0)
  92. {
  93. XtraMessageBox.Show("请选择需要GDOP分析的数据信息!");
  94. return;
  95. }
  96. var item = gridView1.GetRow(ids[0]) as XDPosRes;
  97. X2D1GDOPParam x2D1GdopParam = new X2D1GDOPParam(item.SigTime);
  98. x2D1GdopParam.mapControl1 = mapControl1;
  99. PopupHelper.ShowPopup(x2D1GdopParam, mapControl1, mapControl1.Width / 4);
  100. })
  101. .AddMenu("绘制误差椭圆", SvgHelper.LoadFromFile("Image\\误差椭圆.svg"), () =>
  102. {
  103. var ids = gridView1.GetSelectedRows();
  104. if (ids.Length <= 0)
  105. {
  106. XtraMessageBox.Show("请选择需要手动绘制误差椭圆的数据信息!");
  107. return;
  108. }
  109. var item = gridView1.GetRow(ids[0]) as XDPosRes;
  110. X2D1ErrEllipseParam x2D1ErrEllipseParam = new X2D1ErrEllipseParam(item.SigTime);
  111. x2D1ErrEllipseParam.mapControl1 = mapControl1;
  112. x2D1ErrEllipseParam.lon = item.PosLon;
  113. x2D1ErrEllipseParam.lat = item.PosLat;
  114. PopupHelper.ShowPopup(x2D1ErrEllipseParam, mapControl1, mapControl1.Width / 4);
  115. })
  116. .AddMenu("停止加载", SvgHelper.LoadFromFile("Image\\Stop.svg"), () => stoped = true);
  117. mapControl1.UseDefalutOptions()
  118. //.UseCluster()//定位点使用内置聚合
  119. .UseClearAll()
  120. .UseDistanceLine()
  121. .UseMarkDot()
  122. //.UseExportImg()
  123. //.UseExportXlsx()
  124. //.UseExportCsv()
  125. .UseDrawRect(rect =>
  126. {
  127. if (dtxdctrl != null)
  128. {
  129. dtxdctrl.rect = rect;
  130. }
  131. });
  132. //MapMenu为地图瓦片上右键菜单
  133. //AddPosMenu为定位点上右键菜单
  134. //RectMenu为框选的区域上右键菜单
  135. mapControl1.AddMapMenu("加载仿真数据", SvgHelper.LoadFromFile("Image\\LoadData.svg"), (lon, lat) => LoadSimulationData())
  136. .AddMapMenu("停止加载", SvgHelper.LoadFromFile("Image\\Stop.svg"), (lon, lat) => stoped = true)
  137. .AddMapMenu("历史航迹", SvgHelper.LoadFromFile("Image\\history.svg"), (lon, lat) => LoadHistoryData())
  138. .AddPosMenu<XDPosRes>("绘制时差线", SvgHelper.LoadFromFile("Image\\DrawLine.svg"), item =>
  139. {
  140. DrawDtoLine(item);
  141. })
  142. .AddPosMenu<XDPosRes>("GDOP分析", SvgHelper.LoadFromFile("Image\\GDOP.svg"), item =>
  143. {
  144. X2D1GDOPParam x2D1GdopParam = new X2D1GDOPParam(item.SigTime);
  145. x2D1GdopParam.mapControl1 = mapControl1;
  146. PopupHelper.ShowPopup(x2D1GdopParam, mapControl1, mapControl1.Width / 4);
  147. })
  148. .AddPosMenu<XDPosRes>("误差椭圆", SvgHelper.LoadFromFile("Image\\误差椭圆.svg"), item =>
  149. {
  150. X2D1ErrEllipseParam x2D1ErrEllipseParam = new X2D1ErrEllipseParam(item.SigTime);
  151. x2D1ErrEllipseParam.mapControl1 = mapControl1;
  152. x2D1ErrEllipseParam.lon = item.PosLon;
  153. x2D1ErrEllipseParam.lat = item.PosLat;
  154. PopupHelper.ShowPopup(x2D1ErrEllipseParam, mapControl1, mapControl1.Width / 4);
  155. })
  156. .AddRectMenu<XDPosRes>("时差初值预估", SvgHelper.LoadFromFile("Image\\初值预估.svg"), items =>
  157. {
  158. var rect = mapControl1.GetCurrentRect();
  159. if (dtxdctrl == null)
  160. {
  161. dtxdctrl = new DtXDParam();
  162. }
  163. dtxdctrl.rect = rect;
  164. PopupHelper.ShowPopup(dtxdctrl, mapControl1, mapControl1.Width / 4);
  165. })
  166. .AddPosMenu<XDPosRes>("手动定位", SvgHelper.LoadFromFile("Image\\Pos.svg"), item =>
  167. {
  168. XdPos(item);
  169. });
  170. //查询已有的定位记录
  171. using (RHDWContext db = new RHDWContext())
  172. {
  173. List<XDPosRes> list = await db.XDPosRes.ToListAsync();
  174. this.gridPos.DataSource = list;
  175. mapControl1.SetPosDataSource(list);
  176. }
  177. var view = gridPos.MainView as DevExpress.XtraGrid.Views.Grid.GridView;
  178. view.RowClick += View_RowClick;
  179. }
  180. catch (Exception ex)
  181. {
  182. Serilog.Log.Error("查询定位结果失败", ex);
  183. XtraMessageBox.Show("查询定位结果失败");
  184. }
  185. }
  186. private void View_RowClick(object sender, RowClickEventArgs e)
  187. {
  188. if (e.RowHandle < 0) return;
  189. var item = gridView1.GetRow(e.RowHandle) as XDPosRes;
  190. item.Selected = true;
  191. mapControl1.UpdatePosItem(item);
  192. }
  193. private async void LoadHistoryData()
  194. {
  195. string hoistoryFile = Path.Combine(AppDomain.CurrentDomain.BaseDirectory, "historyXD.dat");
  196. if (!File.Exists(hoistoryFile))
  197. {
  198. return;
  199. }
  200. var lines = File.ReadAllLines(hoistoryFile);
  201. foreach (var item in lines)
  202. {
  203. if (stoped) break;
  204. var items = item.Split(new string[] { " ", "\"" }, StringSplitOptions.RemoveEmptyEntries);
  205. if (items.Length != 5) continue;
  206. int index = 0;
  207. string sigtimeStr = items[index++] + " " + items[index++];
  208. var SigTime = DateTime.ParseExact(sigtimeStr, "yyyy-MM-dd HH:mm:ss", null);
  209. XDPosRes posRes = new XDPosRes();
  210. posRes.SigTime = SigTime;
  211. posRes.TarName = items[index++];
  212. posRes.PosLon = Convert.ToDouble(items[index++]);
  213. posRes.PosLat = Convert.ToDouble(items[index++]);
  214. this.Invoke(new Action(() =>
  215. {
  216. mapControl1.AddHistoryPosItem(posRes);
  217. }));
  218. await Task.Delay(200);
  219. }
  220. }
  221. bool stoped = false;
  222. private async void LoadSimulationData()
  223. {
  224. SimulationEditor editor = new SimulationEditor("Simulation_Data2023.dat");
  225. if (editor.ShowDialog() != DialogResult.OK)
  226. {
  227. return;
  228. }
  229. string simulationFile = editor.SimulationFile;
  230. stoped = false;
  231. //在列表控件中全选+右键可以删除所有测试结果
  232. using (RHDWContext db = new RHDWContext())
  233. {
  234. var listTx = db.TxInfos.ToList();
  235. var sysSetings = await db.SysSetings.FirstOrDefaultAsync();
  236. var lines = File.ReadAllLines(simulationFile);
  237. Random r = new Random();
  238. foreach (var item in lines)
  239. {
  240. if (stoped) break;
  241. var items = item.Split(new string[] { " ", "\"" }, StringSplitOptions.RemoveEmptyEntries);
  242. if (items.Length != 15) continue;
  243. int index = 0;
  244. string sigtimeStr = items[index++] + " " + items[index++];
  245. var SigTime = DateTime.ParseExact(sigtimeStr, "yyyy-MM-dd HH:mm:ss", null);
  246. var sxDto = Convert.ToDouble(items[index++]);
  247. var xdDto = Convert.ToDouble(items[index++]);
  248. var mainYbDto = Convert.ToDouble(items[index++]);
  249. var adjaYbDto = Convert.ToDouble(items[index++]);
  250. var mainX = Convert.ToDouble(items[9]);
  251. var mainY = Convert.ToDouble(items[10]);
  252. var mainZ = Convert.ToDouble(items[11]);
  253. var adjaX = Convert.ToDouble(items[12]);
  254. var adjaY = Convert.ToDouble(items[13]);
  255. var adjaZ = Convert.ToDouble(items[14]);
  256. var cgRes = new CgRes()
  257. {
  258. SigTime = SigTime,
  259. DtoSx = sxDto * 1e6,
  260. DfoSx = 200 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
  261. SnrSx = r.Next(18, 24) + Math.Round(r.NextDouble(), 1),
  262. DtoCdb = xdDto * 1e6,
  263. DfoCdb = 600 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
  264. SnrCdb = r.Next(22, 32) + Math.Round(r.NextDouble(), 1),
  265. YbMain = mainYbDto * 1e6,
  266. YbAdja = adjaYbDto * 1e6,
  267. MainX = mainX,
  268. MainY = mainY,
  269. MainZ = mainZ,
  270. AdjaX = adjaX,
  271. AdjaY = adjaY,
  272. AdjaZ = adjaZ,
  273. };
  274. var cg = db.CgRes.Add(cgRes);//参估结果入库
  275. await db.SaveChangesAsync();
  276. var res = PosApi.X2D1_POS(cgRes, listTx);
  277. XDPosRes posRes = new XDPosRes()
  278. {
  279. SigTime = cgRes.SigTime,
  280. CgResID = cgRes.ID,
  281. TarName = "未知目标",
  282. TsName = "tar1",
  283. PosLon = res[0],
  284. PosLat = res[1],
  285. MirrLon = res[3],
  286. MirrLat = res[4]
  287. };
  288. db.XDPosRes.Add(posRes);//定位结果入库
  289. await db.SaveChangesAsync();
  290. SendPosData(posRes, sysSetings);
  291. //更新定位结果UI列表和地图
  292. var currentTask = gridView1.GetFocusedRow() as TaskInfo;
  293. var ds = this.gridPos.DataSource as List<XDPosRes>;
  294. ds.Insert(0, posRes);
  295. this.Invoke(new Action(() =>
  296. {
  297. gridView1.RefreshData();
  298. mapControl1.AddPosItem(posRes);
  299. }));
  300. await Task.Delay(200);
  301. }
  302. }
  303. }
  304. private void SendPosData(XDPosRes pos, SysSetings setings)
  305. {
  306. if (setings == null || string.IsNullOrEmpty(setings.ServerIp) || setings.Port < 0 || setings.Port > 65535)
  307. {
  308. return;
  309. }
  310. string json = Newtonsoft.Json.JsonConvert.SerializeObject(pos);
  311. tcpServer.SendData(setings.ServerIp, setings.Port, json);
  312. }
  313. private async void XdPos()
  314. {
  315. var ids = gridView1.GetSelectedRows();
  316. if (ids.Length <= 0)
  317. {
  318. XtraMessageBox.Show("请选择需要手动定位的数据信息!");
  319. return;
  320. }
  321. var item = gridView1.GetRow(ids[0]) as XDPosRes;
  322. await Task.Run(() =>
  323. {
  324. XdPos(item);
  325. });
  326. }
  327. private async void XdPos(XDPosRes item)
  328. {
  329. try
  330. {
  331. List<TxInfo> listTx = new List<TxInfo>();
  332. CgRes cg;
  333. using (RHDWContext db = new RHDWContext())
  334. {
  335. listTx = db.TxInfos.ToList();
  336. cg = await db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefaultAsync();
  337. }
  338. X2D1PosParamEditor frm = new X2D1PosParamEditor(item, cg, listTx, () =>
  339. {
  340. gridView1.RefreshData();
  341. if (item.PosLon > 180 || item.PosLon < -180)
  342. {
  343. item.PosLon = 0;
  344. item.PosLat = 0;
  345. }
  346. mapControl1.UpdatePosItem(item);
  347. });
  348. frm.ShowDialog();
  349. }
  350. catch (Exception ex)
  351. {
  352. Serilog.Log.Error("手动定位失败", ex);
  353. XtraMessageBox.Show("手动定位失败");
  354. }
  355. }
  356. private async void DrawDtoLine()
  357. {
  358. var ids = gridView1.GetSelectedRows();
  359. if (ids.Length <= 0)
  360. {
  361. XtraMessageBox.Show("请选择需要绘制时差线的定位数据信息!");
  362. return;
  363. }
  364. var item = gridView1.GetRow(ids[0]) as XDPosRes;
  365. await Task.Run(() =>
  366. {
  367. DrawDtoLine(item);
  368. });
  369. }
  370. private async void DrawDtoLine(XDPosRes item)
  371. {
  372. try
  373. {
  374. List<TxInfo> listTx = new List<TxInfo>();
  375. List<XzXdDw.App.Model.SatInfo> listSat = new List<XzXdDw.App.Model.SatInfo>();
  376. CgRes cg;
  377. using (RHDWContext db = new RHDWContext())
  378. {
  379. listTx = db.TxInfos.ToList();
  380. listSat = db.SatInfos.ToList();
  381. cg = await db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefaultAsync();
  382. }
  383. if (cg == null)
  384. {
  385. XtraMessageBox.Show($"未找到定位相关的计算[{item.CgResID}]信息");
  386. return;
  387. }
  388. var satTx = listTx.Find(p => p.TxType == EnumTxType.MainSat);
  389. var satNTx = listTx.Find(p => p.TxType == EnumTxType.AdjaSat);
  390. var cdbTx = listTx.Find(p => p.TxType == EnumTxType.Cdb);
  391. var refTx = listTx.Find(p => p.TxType == EnumTxType.Ref);
  392. DtoLineXdOption dtoLineXd = new DtoLineXdOption();
  393. dtoLineXd.MsEph = new double[] { cg.MainX, cg.MainY, cg.MainZ, 0, 0, 0 };
  394. dtoLineXd.MsAnt = new double[] { satTx.Lon, satTx.Lat, 0 };
  395. dtoLineXd.CDBAnt = new double[] { cdbTx.Lon, cdbTx.Lat, 0 };
  396. dtoLineXd.RefGeod = new double[] { refTx.Lon, refTx.Lat, 0 };
  397. dtoLineXd.xdDto = cg.DtoCdb;
  398. dtoLineXd.RefDto = cg.YbMain;
  399. dtoLineXd.PosLon = item.PosLon;
  400. dtoLineXd.PosLat = item.PosLat;
  401. var xdDtoLine = DrawDtoLineHelper.DtoLineXd(dtoLineXd);
  402. mapControl1.DrawDtoPonit($"星地[{listSat.FirstOrDefault(m => m.ID == satTx.ID)?.Sat},{listSat.FirstOrDefault(m => m.ID == cdbTx.ID)?.Sat}]时差线", xdDtoLine);
  403. DtoLineTwoStartOption twoStartOption = new DtoLineTwoStartOption();
  404. twoStartOption.MsEph = new double[] { cg.MainX, cg.MainY, cg.MainZ, 0, 0, 0 };
  405. twoStartOption.NsEph = new double[] { cg.AdjaX, cg.AdjaY, cg.AdjaZ, 0, 0, 0 };
  406. twoStartOption.MsAnt = new double[] { satTx.Lon, satTx.Lat, 0 };
  407. twoStartOption.NsAnt = new double[] { satNTx.Lon, satNTx.Lat, 0 };
  408. twoStartOption.RefGeod = new double[] { refTx.Lon, refTx.Lat, 0 };
  409. twoStartOption.TargetDto = cg.DtoSx;
  410. twoStartOption.RefDto = cg.YbMain - cg.YbAdja;
  411. twoStartOption.PosLon = item.PosLon;
  412. twoStartOption.PosLat = item.PosLat;
  413. var tsDtoLine = DrawDtoLineHelper.DtoLineXDTwoStart(twoStartOption);
  414. mapControl1.DrawDtoPonit($"双星[{listSat.FirstOrDefault(m => m.ID == satTx.ID)?.Sat},{listSat.FirstOrDefault(m => m.ID == satNTx.ID)?.Sat}]时差线", tsDtoLine);
  415. }
  416. catch (Exception ex)
  417. {
  418. Serilog.Log.Error("绘制时差线失败", ex);
  419. XtraMessageBox.Show($"绘制时差线失败,失败信息:{ex.Message}");
  420. }
  421. }
  422. }
  423. }