CtrlPosSingle.cs 20 KB

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