|
@@ -4,11 +4,17 @@ using System.Data.Entity;
|
|
|
using System.Data.SqlClient;
|
|
|
using System.Data.SQLite;
|
|
|
using System.Linq;
|
|
|
+using System.Security.Cryptography.Xml;
|
|
|
using System.Text;
|
|
|
using System.Threading.Tasks;
|
|
|
using System.Web.Http;
|
|
|
+using System.Windows.Documents;
|
|
|
+using DevExpress.Mvvm.Native;
|
|
|
+using DevExpress.XtraPrinting;
|
|
|
+using Newtonsoft.Json;
|
|
|
using PosResAnalysis;
|
|
|
using Serilog;
|
|
|
+using Swashbuckle.Swagger;
|
|
|
using XdCxRhDw.Dto;
|
|
|
using XdCxRhDW.App.Api;
|
|
|
using XdCxRhDW.App.EFContext;
|
|
@@ -26,12 +32,13 @@ namespace XdCxRhDW.App.WebAPI
|
|
|
/// </summary>
|
|
|
public class PosController : BaseController
|
|
|
{
|
|
|
+
|
|
|
/// <summary>
|
|
|
- /// 执行两星一地定位
|
|
|
+ /// 两星一地带参定位(无星历)
|
|
|
/// </summary>
|
|
|
- /// <returns></returns>
|
|
|
+ /// <returns>返回定位结果ID</returns>
|
|
|
[HttpPost]
|
|
|
- public async Task<AjaxResult> PosX2D1Async(X2D1PosDto dto)
|
|
|
+ public async Task<AjaxResult<long>> PosX2D1Async(X2D1NoXlPosDto dto)
|
|
|
{
|
|
|
using (RHDWContext db = new RHDWContext())
|
|
|
{
|
|
@@ -39,7 +46,7 @@ namespace XdCxRhDW.App.WebAPI
|
|
|
if (runTask == null)
|
|
|
{
|
|
|
Serilog.Log.Warning($"接收到两星一地定位参数,由于任务没有运行中忽略本次定位!");
|
|
|
- return Error($"多模式融合定位平台没有启动两星一地定位任务");
|
|
|
+ return Error<long>($"多模式融合定位平台没有启动两星一地定位任务");
|
|
|
}
|
|
|
var listTx = await db.TxInfos.ToListAsync();
|
|
|
var parameter1 = new SQLiteParameter("@sigTime", dto.SigTime);
|
|
@@ -49,14 +56,14 @@ namespace XdCxRhDW.App.WebAPI
|
|
|
if (xlInfo1 == null)
|
|
|
{
|
|
|
Serilog.Log.Error($"未找到卫星[{dto.MainSatID}]的双行根数星历");
|
|
|
- return Error($"未找到卫星[{dto.MainSatID}]的双行根数星历");
|
|
|
+ return Error<long>($"未找到卫星[{dto.MainSatID}]的双行根数星历");
|
|
|
}
|
|
|
|
|
|
var xlInfo2 = await db.XlInfos.SqlQuery("select * from XlInfo where ABS(JULIANDAY(TimeBJ)-JULIANDAY(@sigTime))=(select min(ABS(JULIANDAY(TimeBJ)-JULIANDAY(@sigTime))) from XlInfo where satcode=@satcode)", parameter1, parameter3).FirstOrDefaultAsync();
|
|
|
if (xlInfo2 == null)
|
|
|
{
|
|
|
Serilog.Log.Error($"未找到卫星[{dto.AdjaSatID}]的双行根数星历");
|
|
|
- return Error($"未找到卫星[{dto.AdjaSatID}]的双行根数星历");
|
|
|
+ return Error<long>($"未找到卫星[{dto.AdjaSatID}]的双行根数星历");
|
|
|
}
|
|
|
Serilog.Log.Information($"卫星{dto.MainSatID}使用{xlInfo1.TwoLine}进行星历推算");
|
|
|
Serilog.Log.Information($"卫星{dto.AdjaSatID}使用{xlInfo2.TwoLine}进行星历推算");
|
|
@@ -104,73 +111,271 @@ namespace XdCxRhDW.App.WebAPI
|
|
|
MirrLon = res[3],
|
|
|
MirrLat = res[4],
|
|
|
};
|
|
|
- db.PosRes.Add(posRes);
|
|
|
+ var tmp = db.PosRes.Add(posRes);
|
|
|
await db.SaveChangesAsync();
|
|
|
+ return Success(posRes.ID);
|
|
|
}
|
|
|
- return Success();
|
|
|
}
|
|
|
+
|
|
|
/// <summary>
|
|
|
- /// 推送时有星厉
|
|
|
+ /// 一星一地测向带参定位(含星历)
|
|
|
/// </summary>
|
|
|
- /// <param name="dto"></param>
|
|
|
+ /// <param name="dto">定位参数</param>
|
|
|
/// <returns></returns>
|
|
|
- readonly Random r = new Random();
|
|
|
[HttpPost]
|
|
|
- public async Task<AjaxResult<double[]>> PosX1D1Async(IEnumerable<SendDto> dtoList)
|
|
|
+ public async Task<AjaxResult<PosRes>> PosX1D1Async(X1D1PosDto dto)
|
|
|
{
|
|
|
+ PosRes posRes = new PosRes();
|
|
|
using (RHDWContext db = new RHDWContext())
|
|
|
{
|
|
|
- foreach (var dto in dtoList)
|
|
|
+ var tsk1X1D = await db.TaskInfos.FirstOrDefaultAsync(p => p.PosType == EnumPosType.X1D1CX && p.TaskState == EnumTaskState.Running);
|
|
|
+ if (tsk1X1D == null)
|
|
|
+ {
|
|
|
+ Serilog.Log.Warning($"接收到一星一地测向带参定位(含星历)参数,由于任务没有运行中忽略本次定位!");
|
|
|
+ return Error<PosRes>($"多模式融合定位平台没有启动一星一地测向定位任务");
|
|
|
+ }
|
|
|
+ var sigTime = DateTime.Now;
|
|
|
+ var listTx = new List<TxInfo>();
|
|
|
+ var cgRes = new CgRes();
|
|
|
+ var cxRes = new CxRes();
|
|
|
+ cgRes = db.CgRes.Add(new CgRes()
|
|
|
+ {
|
|
|
+ SigTime = sigTime,
|
|
|
+ DtoSx = dto.SxDto * 1e6,
|
|
|
+ DtoCdb = dto.XdDto * 1e6,
|
|
|
+ YbMain = dto.MainYbDto * 1e6,
|
|
|
+ YbAdja = dto.AdjaYbDto * 1e6,
|
|
|
+ MainX = dto.MainX,
|
|
|
+ MainY = dto.MainY,
|
|
|
+ MainZ = dto.MainZ,
|
|
|
+ });
|
|
|
+ listTx = await db.TxInfos.ToListAsync();
|
|
|
+ cxRes = db.CxRes.Add(new CxRes()
|
|
|
+ {
|
|
|
+ SigTime = sigTime,
|
|
|
+ Fx = dto.CxRes,
|
|
|
+ });
|
|
|
+ double[] res = new double[6];
|
|
|
+ var satTx = listTx.Find(p => p.TxType == EnumTxType.MainSat);
|
|
|
+ var cdbTx = listTx.Find(p => p.TxType == EnumTxType.Cdb);
|
|
|
+ var cxTx = listTx.Find(p => p.TxType == EnumTxType.Cx);
|
|
|
+ var refTx = listTx.Find(p => p.TxType == EnumTxType.Ref);
|
|
|
+ double[] mainSat = new double[3] { cgRes.MainX, cgRes.MainY, cgRes.MainZ };
|
|
|
+ double[] satStation = new double[3] { satTx.Lon, satTx.Lat, 0 };
|
|
|
+ double[] cdbStation = new double[3] { cdbTx.Lon, cdbTx.Lat, 0 };
|
|
|
+ double[] cxStation = new double[3] { cxTx.Lon, cxTx.Lat, 0 };
|
|
|
+ double[] refStation = new double[3] { refTx.Lon, refTx.Lat, 0 };
|
|
|
+ double[] zone = new double[] { -85, 85, -180, 180 }; //定位区域
|
|
|
+ double theta = cxRes.Fx;//单位°
|
|
|
+ PosApi.X1D1_POS2023_Core(mainSat, satStation, cdbStation, cxStation, refStation, zone, theta, cgRes.DtoCdb / 1e6, cgRes.YbMain / 1e6, res);
|
|
|
+ posRes = new PosRes()
|
|
|
{
|
|
|
- var sigTime = DateTime.Now;
|
|
|
+ SigTime = cgRes.SigTime,
|
|
|
+ TaskID = tsk1X1D.ID,
|
|
|
+ CxResID = cxRes.ID,
|
|
|
+ CgResID = cgRes.ID,
|
|
|
+ TarName = "未知目标",
|
|
|
+ TsName = "DAMA--56-115ms",
|
|
|
+ PosLon = Math.Round(res[0], 4),
|
|
|
+ PosLat = Math.Round(res[1], 4),
|
|
|
+ MirrLon = Math.Round(res[3], 4),
|
|
|
+ MirrLat = Math.Round(res[4], 4),
|
|
|
+ };
|
|
|
+ db.PosRes.Add(posRes);
|
|
|
+ }
|
|
|
+ return Success(posRes);
|
|
|
+ }
|
|
|
|
|
|
- var cgRes = db.CgRes.Add(new CgRes()
|
|
|
- {
|
|
|
- SigTime = sigTime,
|
|
|
- DtoSx = dto.SxDto * 1e6,
|
|
|
- DfoSx = 200 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
|
|
|
- SnrSx = r.Next(18, 24) + Math.Round(r.NextDouble(), 1),
|
|
|
- DtoCdb = dto.XdDto * 1e6,
|
|
|
- DfoCdb = 600 + r.Next(1, 5) + Math.Round(r.NextDouble(), 3),
|
|
|
- SnrCdb = r.Next(22, 32) + Math.Round(r.NextDouble(), 1),
|
|
|
- YbMain = dto.MainYbDto * 1e6,
|
|
|
- YbAdja = dto.AdjaYbDto * 1e6,
|
|
|
- MainX = dto.MainX,
|
|
|
- MainY = dto.MainY,
|
|
|
- MainZ = dto.MainZ,
|
|
|
- AdjaX = dto.AdjaX,
|
|
|
- AdjaY = dto.AdjaY,
|
|
|
- AdjaZ = dto.AdjaZ,
|
|
|
- });
|
|
|
+ /// <summary>
|
|
|
+ /// 两星一地定位(含星历)
|
|
|
+ /// </summary>
|
|
|
+ /// <param name="dto">定位参数</param>
|
|
|
+ /// <returns></returns>
|
|
|
+ [HttpPost]
|
|
|
+ public async Task<AjaxResult<PosRes>> PosX2D1Async(X2D1PosDto dto)
|
|
|
+ {
|
|
|
+ PosRes posRes = new PosRes();
|
|
|
+ using (RHDWContext db = new RHDWContext())
|
|
|
+ {
|
|
|
+ var tsk2X1D = await db.TaskInfos.FirstOrDefaultAsync(p => p.PosType == EnumPosType.X2D1 && p.TaskState == EnumTaskState.Running);
|
|
|
+ if (tsk2X1D == null)
|
|
|
+ {
|
|
|
+ Serilog.Log.Warning($"接收到两星一地带参定位(含星历)参数,由于任务没有运行中忽略本次定位!");
|
|
|
+ return Error<PosRes>($"多模式融合定位平台没有启动两星一地定位任务");
|
|
|
}
|
|
|
+ var sigTime = DateTime.Now;
|
|
|
+ var listTx = new List<TxInfo>();
|
|
|
+ var cgRes = new CgRes();
|
|
|
+ cgRes = db.CgRes.Add(new CgRes()
|
|
|
+ {
|
|
|
+ SigTime = sigTime,
|
|
|
+ DtoSx = dto.SxDto * 1e6,
|
|
|
+ DtoCdb = dto.XdDto * 1e6,
|
|
|
+ YbMain = dto.MainYbDto * 1e6,
|
|
|
+ YbAdja = dto.AdjaYbDto * 1e6,
|
|
|
+ MainX = dto.MainX,
|
|
|
+ MainY = dto.MainY,
|
|
|
+ MainZ = dto.MainZ,
|
|
|
+ AdjaX = dto.AdjaX,
|
|
|
+ AdjaY = dto.AdjaY,
|
|
|
+ AdjaZ = dto.AdjaZ,
|
|
|
+ });
|
|
|
+ listTx = await db.TxInfos.ToListAsync();
|
|
|
+
|
|
|
+ double[] res = new double[6];
|
|
|
+ var satTx = listTx.Find(p => p.TxType == EnumTxType.MainSat);
|
|
|
+ var cdbTx = listTx.Find(p => p.TxType == EnumTxType.Cdb);
|
|
|
+ var cxTx = listTx.Find(p => p.TxType == EnumTxType.Cx);
|
|
|
+ var refTx = listTx.Find(p => p.TxType == EnumTxType.Ref);
|
|
|
+ double[] mainSat = new double[3] { cgRes.MainX, cgRes.MainY, cgRes.MainZ };
|
|
|
+ double[] adjaSat = new double[3] { cgRes.AdjaX, cgRes.AdjaY, cgRes.AdjaZ };
|
|
|
+ double[] satStation = new double[3] { satTx.Lon, satTx.Lat, 0 };
|
|
|
+ double[] cdbStation = new double[3] { cdbTx.Lon, cdbTx.Lat, 0 };
|
|
|
+ double[] cxStation = new double[3] { cxTx.Lon, cxTx.Lat, 0 };
|
|
|
+ double[] refStation = new double[3] { refTx.Lon, refTx.Lat, 0 };
|
|
|
+ double[] zone = new double[] { -85, 85, -180, 180 }; //定位区域
|
|
|
+ PosApi.X2D1_POS_Core(mainSat, adjaSat, cdbStation, satStation, satStation, satStation, satStation, satStation, refStation, zone, cgRes.DtoSx / 1e6, cgRes.DtoCdb / 1e6, cgRes.YbMain / 1e6, cgRes.YbAdja / 1e6, res);
|
|
|
+ posRes = new PosRes()
|
|
|
+ {
|
|
|
+ SigTime = cgRes.SigTime,
|
|
|
+ TaskID = tsk2X1D.ID,
|
|
|
+ CgResID = cgRes.ID,
|
|
|
+ TarName = "未知目标",
|
|
|
+ TsName = "DAMA-225-173ms",
|
|
|
+ PosLon = Math.Round(res[0], 4),
|
|
|
+ PosLat = Math.Round(res[1], 4),
|
|
|
+ MirrLon = Math.Round(res[3], 4),
|
|
|
+ MirrLat = Math.Round(res[4], 4),
|
|
|
+ };
|
|
|
+ db.PosRes.Add(posRes);
|
|
|
}
|
|
|
- var satTx = listTx.Find(p => p.TxType == EnumTxType.MainSat);
|
|
|
- var cdbTx = listTx.Find(p => p.TxType == EnumTxType.Cdb);
|
|
|
- var cxTx = listTx.Find(p => p.TxType == EnumTxType.Cx);
|
|
|
- var refTx = listTx.Find(p => p.TxType == EnumTxType.Ref);
|
|
|
- double[] mainSat = new double[3] { cgRes.MainX, cgRes.MainY, cgRes.MainZ };
|
|
|
- double[] satStation = new double[3] { satTx.Lon, satTx.Lat, 0 };
|
|
|
- double[] cdbStation = new double[3] { cdbTx.Lon, cdbTx.Lat, 0 };
|
|
|
- double[] cxStation = new double[3] { cxTx.Lon, cxTx.Lat, 0 };
|
|
|
- double[] refStation = new double[3] { refTx.Lon, refTx.Lat, 0 };
|
|
|
- double[] zone = new double[] { -85, 85, -180, 180 }; //定位区域
|
|
|
- double theta = cxRes.Fx;//单位°
|
|
|
- double[] res = new double[6];
|
|
|
- PosApi.X1D1_POS2023_Core(mainSat, satStation, cdbStation, cxStation, refStation, zone, theta, cgRes.DtoCdb / 1e6, cgRes.YbMain / 1e6, res);
|
|
|
- return Success(res.Select(p => Math.Round(p, 4)).ToArray());
|
|
|
+ return Success(posRes);
|
|
|
}
|
|
|
+
|
|
|
+ /// <summary>
|
|
|
+ /// 融合定位(含星历)
|
|
|
+ /// </summary>
|
|
|
+ /// <param name="dto">定位参数</param>
|
|
|
+ /// <returns></returns>
|
|
|
[HttpPost]
|
|
|
- //public async Task<AjaxResult<double[]>> PosX1D1NoXlAsync(CgRes cgRes, List<TxInfo> listTx, CxRes cxRes)
|
|
|
- //{
|
|
|
-
|
|
|
- //}
|
|
|
- /// <summary>
|
|
|
- /// 查询定位结果(暂未实现)
|
|
|
- /// </summary>
|
|
|
- /// <param name="dto"></param>
|
|
|
- /// <returns></returns>
|
|
|
- /// <exception cref="Exception"></exception>
|
|
|
- [HttpGet]
|
|
|
+ public async Task<AjaxResult<PosRes>> PosRhAsync(RHPosDto dto)
|
|
|
+ {
|
|
|
+ PosRes posRes = new PosRes();
|
|
|
+ using (RHDWContext db = new RHDWContext())
|
|
|
+ {
|
|
|
+ var tskRh = await db.TaskInfos.FirstOrDefaultAsync(p => p.PosType == EnumPosType.RH && p.TaskState == EnumTaskState.Running);
|
|
|
+ if (tskRh == null)
|
|
|
+ {
|
|
|
+ Serilog.Log.Warning($"接收到融合带参定位(含星历)参数,由于任务没有运行中忽略本次定位!");
|
|
|
+ return Error<PosRes>($"多模式融合定位平台没有启动两星一地定位任务");
|
|
|
+ }
|
|
|
+ var sigTime = DateTime.Now;
|
|
|
+ var listTx = new List<TxInfo>();
|
|
|
+ var cgRes = new CgRes();
|
|
|
+ var cxRes = new CxRes();
|
|
|
+ cgRes = db.CgRes.Add(new CgRes()
|
|
|
+ {
|
|
|
+ SigTime = sigTime,
|
|
|
+ DtoSx = dto.SxDto * 1e6,
|
|
|
+ DtoCdb = dto.XdDto * 1e6,
|
|
|
+ YbMain = dto.MainYbDto * 1e6,
|
|
|
+ YbAdja = dto.AdjaYbDto * 1e6,
|
|
|
+ MainX = dto.MainX,
|
|
|
+ MainY = dto.MainY,
|
|
|
+ MainZ = dto.MainZ,
|
|
|
+ AdjaX = dto.AdjaX,
|
|
|
+ AdjaY = dto.AdjaY,
|
|
|
+ AdjaZ = dto.AdjaZ,
|
|
|
+ });
|
|
|
+ listTx = await db.TxInfos.ToListAsync();
|
|
|
+ cxRes = db.CxRes.Add(new CxRes()
|
|
|
+ {
|
|
|
+ SigTime = sigTime,
|
|
|
+ Fx = dto.CxRes,
|
|
|
+ });
|
|
|
+
|
|
|
+ double[] resX1D1 = new double[6];
|
|
|
+ double[] resX2D1 = new double[6];
|
|
|
+ var satTx = listTx.Find(p => p.TxType == EnumTxType.MainSat);
|
|
|
+ var cdbTx = listTx.Find(p => p.TxType == EnumTxType.Cdb);
|
|
|
+ var cxTx = listTx.Find(p => p.TxType == EnumTxType.Cx);
|
|
|
+ var refTx = listTx.Find(p => p.TxType == EnumTxType.Ref);
|
|
|
+ double[] mainSat = new double[3] { cgRes.MainX, cgRes.MainY, cgRes.MainZ };
|
|
|
+ double[] adjaSat = new double[3] { cgRes.AdjaX, cgRes.AdjaY, cgRes.AdjaZ };
|
|
|
+ double[] satStation = new double[3] { satTx.Lon, satTx.Lat, 0 };
|
|
|
+ double[] cdbStation = new double[3] { cdbTx.Lon, cdbTx.Lat, 0 };
|
|
|
+ double[] cxStation = new double[3] { cxTx.Lon, cxTx.Lat, 0 };
|
|
|
+ double[] refStation = new double[3] { refTx.Lon, refTx.Lat, 0 };
|
|
|
+ double[] zone = new double[] { -85, 85, -180, 180 }; //定位区域
|
|
|
+ double theta = cxRes.Fx;//单位°
|
|
|
+
|
|
|
+ PosApi.X1D1_POS2023_Core(mainSat, satStation, cdbStation, cxStation, refStation, zone, theta, cgRes.DtoCdb / 1e6, cgRes.YbMain / 1e6, resX1D1);
|
|
|
+
|
|
|
+ PosApi.X2D1_POS_Core(mainSat, adjaSat, cdbStation, satStation, satStation, satStation, satStation, satStation, refStation, zone, cgRes.DtoSx / 1e6, cgRes.DtoCdb / 1e6, cgRes.YbMain / 1e6, cgRes.YbAdja / 1e6, resX2D1);
|
|
|
+
|
|
|
+ double[] res = new double[] { 999, 999, 0, 999, 999, 0 };
|
|
|
+ if (PosApi.IsGeoPoint(resX1D1) && PosApi.IsGeoPoint(resX2D1))
|
|
|
+ {
|
|
|
+ res = new double[6] {
|
|
|
+ (resX1D1[0] + resX2D1[0]) / 2 + 0.003,
|
|
|
+ (resX1D1[1] + resX2D1[1]) / 2 - 0.002,
|
|
|
+ (resX1D1[2] + resX2D1[2]) / 2,
|
|
|
+ (resX1D1[3] + resX2D1[3]) / 2 + 0.003,
|
|
|
+ (resX1D1[4] + resX2D1[4]) / 2 - 0.002,
|
|
|
+ (resX1D1[5] + resX2D1[5]) / 2,
|
|
|
+ };
|
|
|
+ }
|
|
|
+ else if (PosApi.IsGeoPoint(resX1D1))
|
|
|
+ {
|
|
|
+ res = new double[6]
|
|
|
+ {
|
|
|
+ resX1D1[0] + 0.003,
|
|
|
+ resX1D1[1] - 0.002,
|
|
|
+ resX1D1[2],
|
|
|
+ resX1D1[3] + 0.003,
|
|
|
+ resX1D1[4] - 0.002,
|
|
|
+ resX1D1[5],
|
|
|
+
|
|
|
+ };
|
|
|
+ }
|
|
|
+ else if (PosApi.IsGeoPoint(resX2D1))
|
|
|
+ {
|
|
|
+ res = new double[6]
|
|
|
+ {
|
|
|
+ resX2D1[0] + 0.003,
|
|
|
+ resX2D1[1] - 0.002,
|
|
|
+ resX2D1[2],
|
|
|
+ resX2D1[3] + 0.003,
|
|
|
+ resX2D1[4] - 0.002,
|
|
|
+ resX2D1[5],
|
|
|
+
|
|
|
+ };
|
|
|
+ }
|
|
|
+ posRes = new PosRes()
|
|
|
+ {
|
|
|
+ SigTime = cgRes.SigTime,
|
|
|
+ TaskID = tskRh.ID,
|
|
|
+ CxResID = cxRes.ID,
|
|
|
+ CgResID = cgRes.ID,
|
|
|
+ TarName = "未知目标",
|
|
|
+ TsName = "DAMA-225-173ms",
|
|
|
+ PosLon = Math.Round(res[0], 4),
|
|
|
+ PosLat = Math.Round(res[1], 4),
|
|
|
+ MirrLon = Math.Round(res[3], 4),
|
|
|
+ MirrLat = Math.Round(res[4], 4),
|
|
|
+ };
|
|
|
+ db.PosRes.Add(posRes);
|
|
|
+ }
|
|
|
+ return Success(posRes);
|
|
|
+ }
|
|
|
+
|
|
|
+ /// <summary>
|
|
|
+ /// 查询定位结果(暂未实现)
|
|
|
+ /// </summary>
|
|
|
+ /// <param name="dto"></param>
|
|
|
+ /// <returns></returns>
|
|
|
+ /// <exception cref="Exception"></exception>
|
|
|
+ [HttpGet]
|
|
|
public async Task<AjaxResult<PosResDto>> GetPosRes(PosResQueryDto dto)
|
|
|
{
|
|
|
await Task.Delay(100);
|