XdCxRhDW/XdCxRhDW.App/WebAPI/Controllers/PosController.cs

using System;
using System.Collections.Generic;
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;
using XdCxRhDW.App.Model;
using XdCxRhDW.App.WebAPI.DTO;
using XdCxRhDW.Dto;
using static System.Windows.Forms.VisualStyles.VisualStyleElement.TextBox;
using static XdCxRhDw.CpuCgTools.FormCpuCg;
using CgRes = XdCxRhDW.App.Model.CgRes;

namespace XdCxRhDW.App.WebAPI
{
    /// <summary>
    /// 定位功能相关接口
    /// </summary>
    public class PosController : BaseController
    {

        /// <summary>
        /// 两星一地带参定位(无星历)
        /// </summary>
        /// <returns>返回定位结果ID</returns>
        [HttpPost]
        public async Task<AjaxResult<long>> PosX2D1Async(X2D1NoXlPosDto dto)
        {
            using (RHDWContext db = new RHDWContext())
            {
                var runTask = await db.TaskInfos.Where(p => p.TaskState == EnumTaskState.Running && p.PosType == EnumPosType.X2D1).FirstOrDefaultAsync();
                if (runTask == null)
                {
                    Serilog.Log.Warning($"接收到两星一地定位参数,由于任务没有运行中忽略本次定位!");
                    return Error<long>($"多模式融合定位平台没有启动两星一地定位任务");
                }
                var listTx = await db.TxInfos.ToListAsync();
                var parameter1 = new SQLiteParameter("@sigTime", dto.SigTime);
                var parameter2 = new SQLiteParameter("@satcode", dto.MainSatID);
                var parameter3 = new SQLiteParameter("@satcode", dto.AdjaSatID);
                var xlInfo1 = 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, parameter2).FirstOrDefaultAsync();
                if (xlInfo1 == null)
                {
                    Serilog.Log.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<long>($"未找到卫星[{dto.AdjaSatID}]的双行根数星历");
                }
                Serilog.Log.Information($"卫星{dto.MainSatID}使用{xlInfo1.TwoLine}进行星历推算");
                Serilog.Log.Information($"卫星{dto.AdjaSatID}使用{xlInfo2.TwoLine}进行星历推算");
                var ephMain = EphHelper.Calc(xlInfo1.TwoLine, dto.SigTime);
                var ephAdja = EphHelper.Calc(xlInfo2.TwoLine, dto.SigTime);
                var cgRes = db.CgRes.Add(new Model.CgRes()
                {
                    SigTime = dto.SigTime,
                    DtoSx = dto.SxDto,
                    DfoSx = dto.SxDfo,
                    SnrSx = dto.SxSnr,
                    DtoCdb = dto.XdDto,
                    DfoCdb = dto.XdDfo,
                    SnrCdb = dto.XdSnr,
                    YbMain = dto.MainYbDto,
                    YbAdja = dto.AdjaYbDto,
                    MainX = ephMain.X,
                    MainY = ephMain.Y,
                    MainZ = ephMain.Z,
                    AdjaX = ephAdja.X,
                    AdjaY = ephAdja.Y,
                    AdjaZ = ephAdja.Z,
                });
                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] { ephMain.X, ephMain.Y, ephMain.Z };
                double[] adjaSat = new double[3] { ephAdja.X, ephAdja.Y, ephAdja.Z };
                double[] satStation = new double[3] { satTx.Lon, satTx.Lat, 0 };
                double[] cdbStation = new double[3] { cdbTx.Lon, cdbTx.Lat, 0 };
                double[] refStation = new double[3] { refTx.Lon, refTx.Lat, 0 };
                double[] zone = new double[] { -85, 85, -180, 180 }; //定位区域
                double[] res = new double[6];
                PosApi.X2D1_POS_Core(mainSat, adjaSat, cdbStation, satStation, satStation, satStation, satStation, satStation, refStation, zone, dto.SxDto / 1e6, dto.XdDto / 1e6, dto.MainYbDto / 1e6, dto.AdjaYbDto / 1e6, res);
                PosRes posRes = new PosRes()
                {
                    SigTime = dto.SigTime,
                    TaskID = runTask.ID,
                    CgResID = cgRes.ID,
                    TarName = string.IsNullOrWhiteSpace(dto.TarName) ? "未知目标" : dto.TarName,
                    TsName = dto.TsName,
                    PosLon = res[0],
                    PosLat = res[1],
                    MirrLon = res[3],
                    MirrLat = res[4],
                };
                var tmp = db.PosRes.Add(posRes);
                await db.SaveChangesAsync();
                return Success(posRes.ID);
            }
        }

        /// <summary>
        /// 一星一地测向带参定位(含星历)
        /// </summary>
        /// <param name="dto">定位参数</param>
        /// <returns></returns>
        [HttpPost]
        public async Task<AjaxResult<PosRes>> PosX1D1Async(X1D1PosDto dto)
        {
            PosRes posRes = new PosRes();
            using (RHDWContext db = new RHDWContext())
            {
                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()
                {
                    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);
        }

        /// <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);
            }
            return Success(posRes);
        }

        /// <summary>
        /// 融合定位(含星历)
        /// </summary>
        /// <param name="dto">定位参数</param>
        /// <returns></returns>
        [HttpPost]
        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);
            return Error<PosResDto>("该功能暂未实现!");
        }

    }
}