Sanya-ips/ipstool/ipssps2/Ips.Sps.Scheduling/SigProces/ProcNormalWorker.cs

using DevExpress.Office.Utils;
using DevExpress.Xpo;
using Ips.CorAlgorithm;
using Ips.Library.Basic;
using Ips.Library.Entity;
using Ips.Sps.Ephs;
using Ips.Sps.Scheduling.Entities;
using Ips.Sps.Scheduling.SigAds;
using Ips.Sps.Sigs;
using Ips.Sps.TskResults.Peses;
using Ips.Sps.TskResults.Pases;
using System;
using System.Collections.Generic;
using System.DirectoryServices;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using Ips.Sps.Refs;

namespace Ips.Sps.Scheduling.SigProces
{
    public class ProcNormalWorker : ProcWorkerBase
    {
        public ProcNormalWorker(RunTsk tsk) : base(tsk)
        {
        }

        private AdSigResult _adResult;

        public override void Execute(AdSigResult adResult, CancellationToken token)
        {
            _adResult = adResult;
            var sig = _adResult.Sig;
            if (sig == null) return;

            ProcSigResult procResult = new ProcSigResult()
            {
                Sig = sig,
                SigTime = adResult.SigTime
            };

            try
            {
                Pas mainPas = _adResult.GetSatPas(sig.MainSatId, CurrentTsk.AdCard.StorePath);
                EphResult mainEph = null;
                //目标信号没有主星，直接退出
                if (sig.SigCategory == SignalCategory.TarSig && mainPas == null)
                {
                    IpsLogger.Warn($"{sig.SigFreq.E6m()}MHz没有[{adResult.SigTime:yyyy-MM-dd HH:mm:ss}]主星文件，跳过处理！");
                    Thread.Sleep(2000);
                    return;
                }
                else if (mainPas != null)
                {
                    mainEph = EphManager.Default.GetEph(mainPas.SatNum, mainPas.SigTime, token);
                }
                //获取信号样本文件和文件偏移
                var sigSample = GetSigSample(sig, out int sampleOffset);

                if (mainPas == null && sigSample == null) return;
                foreach (var adjaSatId in sig.AdjaSatIds)
                {
                    if (token.IsCancellationRequested) continue;
                    var adjaPas = _adResult.GetSatPas(adjaSatId, CurrentTsk.AdCard.StorePath);
                    if (adjaPas == null)
                    {
                        IpsLogger.Warn($"卫星{adjaSatId}信号文件不存在，跳过处理！");
                        Thread.Sleep(2000);
                        continue;
                    }
                    var adjaEph = EphManager.Default.GetEph(adjaPas.SatNum, adResult.SigTime, token);
                    if (adjaEph == null)
                    {
                        IpsLogger.Warn($"卫星{adjaPas.SatNum}星历不存在，跳过处理！");
                        Thread.Sleep(2000);
                        continue;
                    }
                    if (mainPas == null && sigSample == null)
                    {
                        IpsLogger.Warn($"卫星{adjaPas.SatNum}无主星和样本，跳过处理！");
                        continue;
                    }
                    List<Pes> pesList = new List<Pes>();
                    var ts = StopWatchUtil.Run(() =>
                    {
                        if (sigSample == null)
                        {
                            pesList = RunCor(adResult,sig, mainPas, adjaPas, mainEph, adjaEph, token);
                        }
                        else
                        {
                            pesList = RunCorSample(adResult,sig, mainPas, adjaPas, mainEph, adjaEph, sigSample, token);
                        }
                    });
                    IpsLogger.Log(LogType.Info, $"{sig.SigFreq.E6m()}MHz[{mainPas?.SatNum}-{adjaPas?.SatNum}]相关耗时：{ts.TotalSeconds:F1}s,任务：{CurrentTsk.TskName}");
                    if (pesList.IsNotNullOrEmpty())
                    {
                        ProcSigCorItem corItem = new ProcSigCorItem();
                        corItem.MainSatId = mainPas?.SatId ?? 0;
                        corItem.AdjaSatId = adjaSatId;
                        corItem.PesList.AddRange(pesList);
                        procResult.PesCorList.Add(corItem);
                    }
                }
            }
            catch (Exception ex)
            {
                ex.HandleCancelEx(m =>
                {
                    IpsLogger.Error($"任务[{CurrentTsk.TskName}]-[{sig.SigFreq}]执行参估异常",m);
                });
                Thread.Sleep(2000);
            }
            finally
            {
                OnProcSigCompleted(new ProcSigCompeletedEventArgs(procResult));
            }
        }

        protected RunSigSample GetSigSample(RunSig sig, out int sampleOffset)
        {
            sampleOffset = 0;
            RunSigSample sigSample = null;
            if (sig.HasSample)
            {
                var pasStartSec = _adResult.SigTime.Second;
                var pasEndSec = pasStartSec + sig.SigLen;
                sigSample = sig.SigSamples.Find(m => m.Fs == sig.Fs && m.StartSec <= pasStartSec && m.EndSec >= pasEndSec);
                if (sigSample != null)
                {
                    sampleOffset = pasStartSec - sigSample.StartSec;
                }
            }
            return sigSample;
        }

        protected List<Pes> RunCor(AdSigResult adRes,RunSig sig, Pas mainPas, Pas adjaPas, EphResult mainEph, EphResult adjaEph, CancellationToken token)
        {
            double[] dtcr = null;
            if (sig.SigEmtType == EmtType.FixSation)
            {
                dtcr = RefManager.Default.CalcDtCR(adjaPas.SigTime, sig.SigFreq, sig.BandWidth, mainPas?.AntId ?? 0, adjaPas.AntId, mainEph, adjaEph);
            }

            if (dtcr == null)
            {
                dtcr = GeoUtil.CalcDtCR(sig.GetSigRange(), mainEph.GetEphXyz(), adjaEph.GetEphXyz(), mainPas.GetAntLla(), adjaPas.GetAntLla());
            }

            IpsLogger.Info($"{sig.SigFreq.E6m()}MHz,{sig.BandWidth.E3m()}kHz,时差中心:{dtcr[0]:F2}us,范围：{dtcr[1]:F2}us");

            var corOption = new CorOptions(sig.Fs, dtcr[0], dtcr[1]);
            string file1 = mainPas.GetFullName(CurrentTsk.AdCard.StorePath);
            string file2 = adjaPas.GetFullName(CurrentTsk.AdCard.StorePath);
            var execRes = SigCor(adRes, sig, file1, file2, corOption, token);
            if (execRes.ExitCode > 0)
            {
                IpsLogger.Error("参数计算出错，" + execRes.ExitMsg);
                return new List<Pes>();
            }
            var pesList = ProcSigUtil.SaveCorResult(execRes.Result, CurrentTsk, sig, mainPas, adjaPas, mainEph, adjaEph, token);
            return pesList;
        }

        protected List<Pes> RunCorSample(AdSigResult adRes, RunSig sig, Pas mainPas, Pas adjaPas, EphResult mainEph, EphResult adjaEph, RunSigSample sigSample, CancellationToken token)
        {
            List<Pes> pesList = new List<Pes>();
            var mainExecRes = RunCorSampleSingle(adRes, sig, mainPas, mainEph, sigSample, token);
            var adjaExecRes = RunCorSampleSingle(adRes, sig, adjaPas, adjaEph, sigSample, token);
            if (mainExecRes == null && adjaExecRes == null)
                return pesList;

            var mainCorResList = mainExecRes?.Result;
            var adjaCorResList = adjaExecRes?.Result;
            var uow = new UnitOfWork();
            if (mainExecRes != null && mainExecRes.ExitCode == 0
                && adjaExecRes != null && adjaExecRes.ExitCode != 0
                && mainCorResList.Length > 0 && adjaCorResList.Length > 0
                )
            {
                CorResult mainCorRes = mainCorResList[0], adjaCorRes = adjaCorResList[0];
                CorResult corResult = new CorResult();
                corResult.Start = mainCorRes.Start;
                corResult.Length = mainCorRes.Length;
                corResult.Dto = adjaCorRes.Dto - mainCorRes.Dto;
                corResult.Dfo = adjaCorRes.Dfo - mainCorRes.Dfo;
                corResult.Snr = Math.Min(mainCorRes.Snr, adjaCorRes.Snr);
                corResult.UseTime = mainCorRes.UseTime + adjaCorRes.UseTime;
                corResult.IsValid = mainCorRes.IsValid && adjaCorRes.IsValid;
                var resList = ProcSigUtil.SaveCorResult(new[] { corResult }, CurrentTsk, sig, mainPas, adjaPas, mainEph, adjaEph, token);
                pesList.AddRange(resList);
            }
            if (mainExecRes != null && mainExecRes.ExitCode == 0 && mainExecRes.Result.IsNotNullOrEmpty())
            {
                var resList = ProcSigUtil.SaveCorResult(mainExecRes.Result, CurrentTsk, sig, mainPas, null, mainEph, null, token);
                pesList.AddRange(resList);
            }
            if (adjaExecRes != null && adjaExecRes.ExitCode == 0 && adjaExecRes.Result.IsNotNullOrEmpty())
            {
                var resList = ProcSigUtil.SaveCorResult(adjaExecRes.Result, CurrentTsk, sig, null, adjaPas, null, adjaEph, token);
                pesList.AddRange(resList);
            }
            return pesList;
        }

        protected ExeResult<CorResult[]> RunCorSampleSingle(AdSigResult adRes, RunSig sig, Pas pas, EphResult eph, RunSigSample sigSample, CancellationToken token)
        {

            if (pas == null) return null;
            double[] dtcr = null;
            if (sig.SigEmtType == EmtType.FixSation)
            {
                dtcr = RefManager.Default.CalcDtCR(pas.SigTime, sig.SigFreq, sig.BandWidth, 0, pas.AntId, null, eph);
            }
            if (dtcr == null)
            {
                dtcr = GeoUtil.CalcDtCR(sig.GetSigRange(), eph.GetEphXyz(), pas.GetAntLla());
            }

            IpsLogger.Info($"{sig.SigFreq.E6m()}MHz,{sig.BandWidth.E3m()}kHz,时差中心:{dtcr[0]:F2}us,范围：{dtcr[1]:F2}us");

            var corOption = new CorOptions(sig.Fs, dtcr[0], dtcr[1]);

            corOption.TimeOffset = pas.SigTime.Second - sigSample.StartSec;
            corOption.OffsetType = CorOffsetType.SigOffset;

            string file1 = sigSample.SampleFile;
            string file2 = pas.GetFullName(CurrentTsk.AdCard.StorePath);
            var corExeReulst = SigCor(adRes, sig, file1, file2, corOption, token);
            return corExeReulst;
        }
    }
}