CtrlPosXd.cs 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430
  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.CgResID);
  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.CgResID);
  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. .AddPosMenu<XDPosRes>("绘制时差线", SvgHelper.LoadFromFile("Image\\DrawLine.svg"), item =>
  138. {
  139. DrawDtoLine(item);
  140. })
  141. .AddPosMenu<XDPosRes>("GDOP分析", SvgHelper.LoadFromFile("Image\\GDOP.svg"), item =>
  142. {
  143. X2D1GDOPParam x2D1GdopParam = new X2D1GDOPParam(item.CgResID);
  144. x2D1GdopParam.mapControl1 = mapControl1;
  145. PopupHelper.ShowPopup(x2D1GdopParam, mapControl1, mapControl1.Width / 4);
  146. })
  147. .AddPosMenu<XDPosRes>("误差椭圆", SvgHelper.LoadFromFile("Image\\误差椭圆.svg"), item =>
  148. {
  149. X2D1ErrEllipseParam x2D1ErrEllipseParam = new X2D1ErrEllipseParam(item.CgResID);
  150. x2D1ErrEllipseParam.mapControl1 = mapControl1;
  151. x2D1ErrEllipseParam.lon = item.PosLon;
  152. x2D1ErrEllipseParam.lat = item.PosLat;
  153. PopupHelper.ShowPopup(x2D1ErrEllipseParam, mapControl1, mapControl1.Width / 4);
  154. })
  155. .AddRectMenu<XDPosRes>("时差初值预估", SvgHelper.LoadFromFile("Image\\初值预估.svg"), items =>
  156. {
  157. var rect = mapControl1.GetCurrentRect();
  158. if (dtxdctrl == null)
  159. {
  160. dtxdctrl = new DtXDParam();
  161. }
  162. dtxdctrl.rect = rect;
  163. PopupHelper.ShowPopup(dtxdctrl, mapControl1, mapControl1.Width / 4);
  164. })
  165. .AddPosMenu<XDPosRes>("手动定位", SvgHelper.LoadFromFile("Image\\Pos.svg"), item =>
  166. {
  167. XdPos(item);
  168. });
  169. //查询已有的定位记录
  170. using (RHDWContext db = new RHDWContext())
  171. {
  172. List<XDPosRes> list = await db.XDPosRes.ToListAsync();
  173. this.gridPos.DataSource = list;
  174. mapControl1.SetPosDataSource(list);
  175. }
  176. var view = gridPos.MainView as DevExpress.XtraGrid.Views.Grid.GridView;
  177. view.RowClick += View_RowClick;
  178. }
  179. catch (Exception ex)
  180. {
  181. Serilog.Log.Error("查询定位结果失败", ex);
  182. XtraMessageBox.Show("查询定位结果失败");
  183. }
  184. }
  185. private void View_RowClick(object sender, RowClickEventArgs e)
  186. {
  187. if (e.RowHandle < 0) return;
  188. var item = gridView1.GetRow(e.RowHandle) as XDPosRes;
  189. item.Selected = true;
  190. mapControl1.UpdatePosItem(item);
  191. }
  192. bool stoped = false;
  193. private async void LoadSimulationData()
  194. {
  195. SimulationEditor editor = new SimulationEditor("Simulation_Data2023.dat");
  196. if (editor.ShowDialog() != DialogResult.OK)
  197. {
  198. return;
  199. }
  200. string simulationFile = editor.SimulationFile;
  201. stoped = false;
  202. //在列表控件中全选+右键可以删除所有测试结果
  203. using (RHDWContext db = new RHDWContext())
  204. {
  205. var listTx = db.TxInfos.ToList();
  206. var sysSetings = await db.SysSetings.FirstOrDefaultAsync();
  207. var lines = File.ReadAllLines(simulationFile);
  208. Random r = new Random();
  209. foreach (var item in lines)
  210. {
  211. if (stoped) break;
  212. var items = item.Split(new string[] { " ", "\"" }, StringSplitOptions.RemoveEmptyEntries);
  213. if (items.Length != 15) continue;
  214. int index = 0;
  215. string sigtimeStr = items[index++] + " " + items[index++];
  216. var SigTime = DateTime.ParseExact(sigtimeStr, "yyyy-MM-dd HH:mm:ss", null);
  217. var sxDto = Convert.ToDouble(items[index++]);
  218. var xdDto = Convert.ToDouble(items[index++]);
  219. var mainYbDto = Convert.ToDouble(items[index++]);
  220. var adjaYbDto = Convert.ToDouble(items[index++]);
  221. var mainX = Convert.ToDouble(items[9]);
  222. var mainY = Convert.ToDouble(items[10]);
  223. var mainZ = Convert.ToDouble(items[11]);
  224. var adjaX = Convert.ToDouble(items[12]);
  225. var adjaY = Convert.ToDouble(items[13]);
  226. var adjaZ = Convert.ToDouble(items[14]);
  227. var cgRes = new CgRes()
  228. {
  229. SigTime = SigTime,
  230. DtoSx = sxDto * 1e6,
  231. DfoSx = 200 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
  232. SnrSx = r.Next(18, 24) + Math.Round(r.NextDouble(), 1),
  233. DtoCdb = xdDto * 1e6,
  234. DfoCdb = 600 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
  235. SnrCdb = r.Next(22, 32) + Math.Round(r.NextDouble(), 1),
  236. YbMain = mainYbDto * 1e6,
  237. YbAdja = adjaYbDto * 1e6,
  238. MainX = mainX,
  239. MainY = mainY,
  240. MainZ = mainZ,
  241. AdjaX = adjaX,
  242. AdjaY = adjaY,
  243. AdjaZ = adjaZ,
  244. };
  245. var cg = db.CgRes.Add(cgRes);//参估结果入库
  246. await db.SaveChangesAsync();
  247. var res = PosApi.X2D1_POS(cgRes, listTx);
  248. XDPosRes posRes = new XDPosRes()
  249. {
  250. SigTime = cgRes.SigTime,
  251. CgResID = cgRes.ID,
  252. TarName = "未知目标",
  253. TsName = "tar1",
  254. PosLon = res[0],
  255. PosLat = res[1],
  256. MirrLon = res[3],
  257. MirrLat = res[4]
  258. };
  259. db.XDPosRes.Add(posRes);//定位结果入库
  260. await db.SaveChangesAsync();
  261. SendPosData(posRes, sysSetings);
  262. //更新定位结果UI列表和地图
  263. var currentTask = gridView1.GetFocusedRow() as TaskInfo;
  264. var ds = this.gridPos.DataSource as List<XDPosRes>;
  265. ds.Insert(0, posRes);
  266. this.Invoke(new Action(() =>
  267. {
  268. gridView1.RefreshData();
  269. mapControl1.AddPosItem(posRes);
  270. }));
  271. await Task.Delay(200);
  272. }
  273. }
  274. }
  275. private void SendPosData(XDPosRes pos, SysSetings setings)
  276. {
  277. if (setings == null || string.IsNullOrEmpty(setings.ServerIp) || setings.Port < 0 || setings.Port > 65535)
  278. {
  279. return;
  280. }
  281. string json = Newtonsoft.Json.JsonConvert.SerializeObject(pos);
  282. tcpServer.SendData(setings.ServerIp, setings.Port, json);
  283. }
  284. private async void XdPos()
  285. {
  286. var ids = gridView1.GetSelectedRows();
  287. if (ids.Length <= 0)
  288. {
  289. XtraMessageBox.Show("请选择需要手动定位的数据信息!");
  290. return;
  291. }
  292. var item = gridView1.GetRow(ids[0]) as XDPosRes;
  293. await Task.Run(() =>
  294. {
  295. XdPos(item);
  296. });
  297. }
  298. private async void XdPos(XDPosRes item)
  299. {
  300. try
  301. {
  302. List<TxInfo> listTx = new List<TxInfo>();
  303. CgRes cg;
  304. using (RHDWContext db = new RHDWContext())
  305. {
  306. listTx = db.TxInfos.ToList();
  307. cg = await db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefaultAsync();
  308. }
  309. X2D1PosParamEditor frm = new X2D1PosParamEditor(item, cg, listTx, () =>
  310. {
  311. gridView1.RefreshData();
  312. if (item.PosLon > 180 || item.PosLon < -180)
  313. {
  314. item.PosLon = 0;
  315. item.PosLat = 0;
  316. }
  317. mapControl1.UpdatePosItem(item);
  318. });
  319. frm.ShowDialog();
  320. }
  321. catch (Exception ex)
  322. {
  323. Serilog.Log.Error("手动定位失败", ex);
  324. XtraMessageBox.Show("手动定位失败");
  325. }
  326. }
  327. private async void DrawDtoLine()
  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 XDPosRes;
  336. await Task.Run(() =>
  337. {
  338. DrawDtoLine(item);
  339. });
  340. }
  341. private async void DrawDtoLine(XDPosRes item)
  342. {
  343. try
  344. {
  345. List<TxInfo> listTx = new List<TxInfo>();
  346. List<XzXdDw.App.Model.SatInfo> listSat = new List<XzXdDw.App.Model.SatInfo>();
  347. CgRes cg;
  348. using (RHDWContext db = new RHDWContext())
  349. {
  350. listTx = db.TxInfos.ToList();
  351. listSat = db.SatInfos.ToList();
  352. cg = await db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefaultAsync();
  353. }
  354. if (cg == null)
  355. {
  356. XtraMessageBox.Show($"未找到定位相关的计算[{item.CgResID}]信息");
  357. return;
  358. }
  359. var satTx = listTx.Find(p => p.TxType == EnumTxType.MainSat);
  360. var satNTx = listTx.Find(p => p.TxType == EnumTxType.AdjaSat);
  361. var cdbTx = listTx.Find(p => p.TxType == EnumTxType.Cdb);
  362. var refTx = listTx.Find(p => p.TxType == EnumTxType.Ref);
  363. DtoLineXdOption dtoLineXd = new DtoLineXdOption();
  364. dtoLineXd.MsEph = new double[] { cg.MainX, cg.MainY, cg.MainZ, 0, 0, 0 };
  365. dtoLineXd.MsAnt = new double[] { satTx.Lon, satTx.Lat, 0 };
  366. dtoLineXd.CDBAnt = new double[] { cdbTx.Lon, cdbTx.Lat, 0 };
  367. dtoLineXd.RefGeod = new double[] { refTx.Lon, refTx.Lat, 0 };
  368. dtoLineXd.xdDto = cg.DtoCdb;
  369. dtoLineXd.RefDto = cg.YbMain;
  370. dtoLineXd.PosLon = item.PosLon;
  371. dtoLineXd.PosLat = item.PosLat;
  372. var xdDtoLine = DrawDtoLineHelper.DtoLineXd(dtoLineXd);
  373. mapControl1.DrawDtoPonit($"星地[{listSat.FirstOrDefault(m => m.ID == satTx.ID)?.Sat},{listSat.FirstOrDefault(m => m.ID == cdbTx.ID)?.Sat}]时差线", xdDtoLine);
  374. DtoLineTwoStartOption twoStartOption = new DtoLineTwoStartOption();
  375. twoStartOption.MsEph = new double[] { cg.MainX, cg.MainY, cg.MainZ, 0, 0, 0 };
  376. twoStartOption.NsEph = new double[] { cg.AdjaX, cg.AdjaY, cg.AdjaZ, 0, 0, 0 };
  377. twoStartOption.MsAnt = new double[] { satTx.Lon, satTx.Lat, 0 };
  378. twoStartOption.NsAnt = new double[] { satNTx.Lon, satNTx.Lat, 0 };
  379. twoStartOption.RefGeod = new double[] { refTx.Lon, refTx.Lat, 0 };
  380. twoStartOption.TargetDto = cg.DtoSx;
  381. twoStartOption.RefDto = cg.YbMain - cg.YbAdja;
  382. twoStartOption.PosLon = item.PosLon;
  383. twoStartOption.PosLat = item.PosLat;
  384. var tsDtoLine = DrawDtoLineHelper.DtoLineXDTwoStart(twoStartOption);
  385. mapControl1.DrawDtoPonit($"双星[{listSat.FirstOrDefault(m => m.ID == satTx.ID)?.Sat},{listSat.FirstOrDefault(m => m.ID == satNTx.ID)?.Sat}]时差线", tsDtoLine);
  386. }
  387. catch (Exception ex)
  388. {
  389. Serilog.Log.Error("绘制时差线失败", ex);
  390. XtraMessageBox.Show($"绘制时差线失败,失败信息:{ex.Message}");
  391. }
  392. }
  393. }
  394. }