CtrlPosSingle.cs 19 KB

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