CtrlPosXd.cs 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350
  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.DTO;
  25. using XdCxRhDW.App.UserControl;
  26. using XzXdDw.App.Api;
  27. using XzXdDw.App.Api.星地GDOP误差椭圆;
  28. using XzXdDw.App.EditForms;
  29. using XzXdDw.App.EFContext;
  30. using XzXdDw.App.Model;
  31. namespace XzXdDw.App.UserControl
  32. {
  33. /// <summary>
  34. /// 星地定位
  35. /// </summary>
  36. public partial class CtrlPosXd : DevExpress.XtraEditors.XtraUserControl
  37. {
  38. DtXDParam dtxdctrl = null;
  39. public CtrlPosXd()
  40. {
  41. InitializeComponent();
  42. }
  43. private async void CtrlXdPos_Load(object sender, EventArgs e)
  44. {
  45. try
  46. {
  47. gridPos.Init().UseMultiSelect().UseFilter().UseRowNumber().UseExportXlsx()
  48. .AddMenu("删除", SvgHelper.CreateClose(), async () =>
  49. {
  50. try
  51. {
  52. if (XtraMessageBox.Show("确认删除?(Ctrl+A可全选删除)", "确认", MessageBoxButtons.YesNo, MessageBoxIcon.Question) != DialogResult.Yes)
  53. {
  54. return;
  55. }
  56. var ids = gridView1.GetSelectedRows();
  57. List<PosRes> deletePos = new List<PosRes>();
  58. using (RHDWContext db = new RHDWContext())
  59. {
  60. foreach (var id in ids)
  61. {
  62. var item = gridView1.GetRow(id) as PosRes;
  63. var delItem = await db.PosRes.Where(p => p.ID == item.ID).FirstOrDefaultAsync();
  64. if (delItem != null)
  65. {
  66. db.PosRes.Remove(delItem);
  67. }
  68. deletePos.Add(item);
  69. }
  70. await db.SaveChangesAsync();
  71. }
  72. gridView1.DeleteSelectedRows();
  73. mapControl1.DelPosItem(deletePos);
  74. }
  75. catch (Exception ex)
  76. {
  77. Serilog.Log.Error("删除结果失败", ex);
  78. XtraMessageBox.Show("删除结果失败");
  79. }
  80. })
  81. .AddMenu("手动定位", SvgHelper.LoadFromFile("Image\\Pos.svg"), XdPos)
  82. .AddMenu("加载仿真数据", SvgHelper.LoadFromFile("Image\\LoadData.svg"), LoadTestData)
  83. .AddMenu("停止加载", SvgHelper.LoadFromFile("Image\\Stop.svg"), () => stoped = true);
  84. mapControl1.UseDefalutOptions()
  85. //.UseCluster()//定位点使用内置聚合
  86. .UseClearAll()
  87. .UseDistanceLine()
  88. .UseMarkDot()
  89. //.UseExportImg()
  90. //.UseExportXlsx()
  91. //.UseExportCsv()
  92. .UseDrawRect(rect =>
  93. {
  94. if (dtxdctrl != null)
  95. {
  96. dtxdctrl.rect = rect;
  97. }
  98. });
  99. //MapMenu为地图瓦片上右键菜单
  100. //AddPosMenu为定位点上右键菜单
  101. //RectMenu为框选的区域上右键菜单
  102. mapControl1.AddMapMenu("加载仿真数据", SvgHelper.LoadFromFile("Image\\LoadData.svg"), (lon, lat) => LoadTestData())
  103. .AddMapMenu("停止加载", SvgHelper.LoadFromFile("Image\\Stop.svg"), (lon, lat) => stoped = true)
  104. .AddMapMenu("GDOP分析", SvgHelper.LoadFromFile("Image\\GDOP.svg"), (lon, lat) =>
  105. {
  106. var ctrl = new X2D1GDOPParam();
  107. PopupHelper.ShowPopup(ctrl, mapControl1, mapControl1.Width / 4, onHide: hideReason =>
  108. {
  109. if (hideReason == HideReason.Defalut) return;
  110. var model = ctrl.Model;
  111. var (listSat, data) = GdopHelper.Gdop2Sat1DRef(new double[] { model.StationLon, model.StationLat },
  112. new double[] { model.RefLon, model.RefLat }, model.TleMain, model.TleAdja, model.CapTime, model.DtousErr, model.SatLocErr);
  113. if (data == null)
  114. {
  115. return;
  116. }
  117. if (listSat != null)//画卫星
  118. {
  119. foreach (var sat in listSat)
  120. {
  121. mapControl1.Invoke(new Action(() =>
  122. {
  123. string satCode = sat.SatCode == null ? "未知" : sat.SatCode.ToString();
  124. mapControl1.DrawFixedImg("sat", sat.SatLat, sat.SatLon, DxHelper.SvgHelper.CreateSat(), new Size(32, 32), $"卫星编号:{satCode}\r\n轨道经度:{sat.SatLon}°\r\n轨道纬度:{sat.SatLat}°");
  125. }));
  126. }
  127. }
  128. foreach (var errLins in data)//画GDOP
  129. {
  130. foreach (var line in errLins.MapLines)
  131. {
  132. var newLine = SampleDots(line);
  133. mapControl1.Invoke(new Action(() =>
  134. {
  135. var mapLines = newLine.Line.Select(p => (errLins.ErrDistanceKm, p.Lon, p.Lat));
  136. mapControl1.DrawGdopLine(mapLines);
  137. }));
  138. }
  139. }
  140. });
  141. })
  142. .AddPosMenu<PosRes>("误差椭圆", SvgHelper.LoadFromFile("Image\\误差椭圆.svg"), item =>
  143. {
  144. string msg = "星地我这里只有GDOP和定位\r\n罗博士和黎强应该有相关算法\r\n关闭后将自动绘制高轨双星误差椭圆";
  145. PopupHelper.ShowPopup(new MsgUserControl(msg), mapControl1, mapControl1.Width / 4, onHide: hideReason =>
  146. {
  147. if (hideReason == HideReason.Defalut)
  148. {
  149. var (listSat, data) = ErrEllipseHelper.ErrEllipse2SatDtoDfoRef(TestData.TleMain, TestData.TleAdja1, DateTime.Now, 1000, 500, 2225, 2225,
  150. new double[] { TestData.TarLon, TestData.TarLat },
  151. new double[] { TestData.RefLon, TestData.RefLat },
  152. out double R1, out double R2);
  153. if (data == null)
  154. {
  155. return;
  156. }
  157. if (listSat != null)//画卫星
  158. {
  159. foreach (var sat in listSat)
  160. {
  161. mapControl1.Invoke(new Action(() =>
  162. {
  163. string satCode = sat.SatCode == null ? "未知" : sat.SatCode.ToString();
  164. mapControl1.DrawFixedImg("sat", sat.SatLat, sat.SatLon, DxHelper.SvgHelper.CreateSat(), new Size(32, 32), $"卫星编号:{satCode}\r\n轨道经度:{sat.SatLon}°\r\n轨道纬度:{sat.SatLat}°");
  165. }));
  166. }
  167. }
  168. foreach (var errLins in data)//画误差椭圆
  169. {
  170. foreach (var line in errLins.MapLines)
  171. {
  172. var newLine = SampleDots(line);
  173. mapControl1.Invoke(new Action(() =>
  174. {
  175. var mapLines = newLine.Line.Select(p => (p.Lon, p.Lat));
  176. mapControl1.DrawErrEllipse(R1, R2, mapLines);
  177. }));
  178. }
  179. }
  180. }
  181. });
  182. })
  183. .AddRectMenu<PosRes>("时差初值预估", SvgHelper.LoadFromFile("Image\\初值预估.svg"), items =>
  184. {
  185. var rect = mapControl1.GetCurrentRect();
  186. if (dtxdctrl == null)
  187. {
  188. dtxdctrl = new DtXDParam();
  189. }
  190. dtxdctrl.rect = rect;
  191. PopupHelper.ShowPopup(dtxdctrl, mapControl1, mapControl1.Width / 4);
  192. });
  193. //查询已有的定位记录
  194. using (RHDWContext db = new RHDWContext())
  195. {
  196. List<PosRes> list = await db.PosRes.ToListAsync();
  197. this.gridPos.DataSource = list;
  198. mapControl1.SetPosDataSource(list);
  199. }
  200. }
  201. catch (Exception ex)
  202. {
  203. Serilog.Log.Error("查询定位结果失败", ex);
  204. XtraMessageBox.Show("查询定位结果失败");
  205. }
  206. }
  207. bool stoped = false;
  208. private async void LoadTestData()
  209. {
  210. stoped = false;
  211. //在列表控件中全选+右键可以删除所有测试结果
  212. using (RHDWContext db = new RHDWContext())
  213. {
  214. var listTx = db.TxInfos.ToList();
  215. var lines = File.ReadAllLines("Simulation_Data2023.dat");
  216. Random r = new Random();
  217. foreach (var item in lines)
  218. {
  219. if (stoped) break;
  220. var items = item.Split(" ".ToCharArray(), StringSplitOptions.RemoveEmptyEntries);
  221. var sxDto = Convert.ToDouble(items[0]);
  222. var xdDto = Convert.ToDouble(items[1]);
  223. var mainYbDto = Convert.ToDouble(items[2]);
  224. var adjaYbDto = Convert.ToDouble(items[3]);
  225. var mainX = Convert.ToDouble(items[7]);
  226. var mainY = Convert.ToDouble(items[8]);
  227. var mainZ = Convert.ToDouble(items[9]);
  228. var adjaX = Convert.ToDouble(items[10]);
  229. var adjaY = Convert.ToDouble(items[11]);
  230. var adjaZ = Convert.ToDouble(items[12]);
  231. var cgRes = new CgRes()
  232. {
  233. SigTime = DateTime.Now,
  234. DtoSx = sxDto * 1e6,
  235. DfoSx = 200 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
  236. SnrSx = r.Next(18, 24) + Math.Round(r.NextDouble(), 1),
  237. DtoCdb = xdDto * 1e6,
  238. DfoCdb = 600 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
  239. SnrCdb = r.Next(22, 32) + Math.Round(r.NextDouble(), 1),
  240. YbMain = mainYbDto * 1e6,
  241. YbAdja = adjaYbDto * 1e6,
  242. MainX = mainX,
  243. MainY = mainY,
  244. MainZ = mainZ,
  245. AdjaX = adjaX,
  246. AdjaY = adjaY,
  247. AdjaZ = adjaZ,
  248. };
  249. var cg = db.CgRes.Add(cgRes);//参估结果入库
  250. await db.SaveChangesAsync();
  251. var res = PosApi.X2D1_POS(cgRes, listTx);
  252. PosRes posRes = new PosRes()
  253. {
  254. SigTime = cgRes.SigTime,
  255. CgResID = cgRes.ID,
  256. TarName = "未知目标",
  257. TsName = "tar1",
  258. PosLon = res[0],
  259. PosLat = res[1],
  260. MirrLon = res[3],
  261. MirrLat = res[4]
  262. };
  263. db.PosRes.Add(posRes);//定位结果入库
  264. await db.SaveChangesAsync();
  265. //更新定位结果UI列表和地图
  266. var currentTask = gridView1.GetFocusedRow() as TaskInfo;
  267. var ds = this.gridPos.DataSource as List<PosRes>;
  268. ds.Insert(0, posRes);
  269. this.Invoke(new Action(() =>
  270. {
  271. gridView1.RefreshData();
  272. mapControl1.AddPosItem(posRes);
  273. }));
  274. await Task.Delay(200);
  275. }
  276. }
  277. }
  278. private async void XdPos()
  279. {
  280. try
  281. {
  282. var ids = gridView1.GetSelectedRows();
  283. if (ids.Length <= 0)
  284. {
  285. XtraMessageBox.Show("请选择需要手动定位的数据信息!");
  286. return;
  287. }
  288. var item = gridView1.GetRow(ids[0]) as PosRes;
  289. List<TxInfo> listTx = new List<TxInfo>();
  290. CgRes cg;
  291. using (RHDWContext db = new RHDWContext())
  292. {
  293. listTx = db.TxInfos.ToList();
  294. cg = await db.CgRes.Where(m => m.ID == item.CgResID).FirstOrDefaultAsync();
  295. }
  296. X2D1PosParamEditor frm = new X2D1PosParamEditor(item, cg, listTx, () =>
  297. {
  298. gridView1.RefreshData();
  299. if (item.PosLon > 180 || item.PosLon < -180)
  300. {
  301. item.PosLon = 0;
  302. item.PosLat = 0;
  303. }
  304. mapControl1.UpdatePosItem(item);
  305. });
  306. frm.ShowDialog();
  307. }
  308. catch (Exception ex)
  309. {
  310. Serilog.Log.Error("手动定位失败", ex);
  311. XtraMessageBox.Show("手动定位失败");
  312. }
  313. }
  314. public XdCxRhDW.App.DTO.MapLine SampleDots(XdCxRhDW.App.DTO.MapLine line)
  315. {
  316. var dots = line.Line;
  317. if (dots.Count < 30) return line;
  318. var tmp = dots.Count / 30;
  319. var newLine = new XdCxRhDW.App.DTO.MapLine();
  320. for (int i = 0; i < dots.Count; i += tmp)
  321. {
  322. newLine.Line.Add(dots[i]);
  323. }
  324. if (!newLine.Line.Contains(dots.Last()))
  325. newLine.Line.Add(dots.Last());
  326. return newLine;
  327. }
  328. }
  329. }