XdCxRhDW/XdCxRhDW.Core/Api/时差线/DrawDtoLineHelper.cs


using System;
using System.Collections.Generic;
using System.Diagnostics;
using System.IO;
using System.Linq;
using System.Runtime.InteropServices;

namespace XdCxRhDW.Core.Api
{
    public class DrawDtoLineHelper
    {
        private const string XdtsDll = @"Api\时差线\Positioning.dll";

        [DllImport(XdtsDll, EntryPoint = "CurveByTwoTDOA", CallingConvention = CallingConvention.Cdecl)]//星地时差线
        public extern static void CurveByTwoTDOA(double[] main_sat_pos, double[] neigh_sat_pos, double[] rec1_pos, double[] rec2_pos, double[] ref_pos, double[] Zone,
      double target_dto, double ref_dto, out IntPtr LOP_Value, ref int LOP_Len);

        private const string exeName = "XingDiSCX.exe";
        private static double[] zone = new double[] { -85, 85, -180, 180 }; //定位区域
        /// <summary>
        /// 星地时差线
        /// </summary>
        /// <param name="opt"></param>
        /// <returns></returns>
        /// <exception cref="Exception"></exception>
        public static IEnumerable<(double lon, double lat)> DtoLineXd(DtoLineXdOption opt)
        {
            List<DtoLinePoint> list = new List<DtoLinePoint>();

            string file = Path.Combine(AppDomain.CurrentDomain.BaseDirectory, "API\\时差线\\DtoLine.dat");
            string exePath = Path.Combine(AppDomain.CurrentDomain.BaseDirectory, "API\\时差线");
            if (string.IsNullOrWhiteSpace(exePath))
                throw new Exception($"请先调用SetExePath指定{exeName}进程所在路径,支持相对路径");
            if (!Directory.Exists(exePath))
                throw new Exception($"路径[{exePath}]不存在");
            var exeFile = Path.Combine(exePath, exeName);
            if (!File.Exists(exeFile))
                throw new Exception($"文件[{exeFile}]不存在");
            List<string> arguments = new List<string>();
            arguments.Add(file);
            arguments.Add($"{opt.MsEph[0]}");
            arguments.Add($"{opt.MsEph[1]}");
            arguments.Add($"{opt.MsEph[2]}");

            arguments.Add($"{opt.MsAnt[0]}");
            arguments.Add($"{opt.MsAnt[1]}");

            arguments.Add($"{opt.CDBAnt[0]}");
            arguments.Add($"{opt.CDBAnt[1]}");

            arguments.Add($"{opt.RefGeod[0]}");
            arguments.Add($"{opt.RefGeod[1]}");

            arguments.Add($"{opt.xdDto}");
            arguments.Add($"{opt.RefDto}");


            arguments.Add($"{opt.PosLon}");
            arguments.Add($"{opt.PosLat}");
            Process p = new Process();
            p.StartInfo.WorkingDirectory = exePath;
            p.StartInfo.FileName = exeFile;
            p.StartInfo.Arguments = string.Join(" ", arguments);
            p.StartInfo.CreateNoWindow = true;
            p.StartInfo.RedirectStandardError = true;
            p.StartInfo.RedirectStandardOutput = true;
            p.StartInfo.UseShellExecute = false;
            p.Start();
            var succeed = p.WaitForExit(10000);
            if (!succeed)
            {
                throw new Exception($"进程[{exeName}]超时未完成!");
            }
            string result = p.StandardOutput.ReadToEnd();
            if (string.IsNullOrWhiteSpace(result))
            {
                throw new Exception("计算时差线出现未知错误!");
            }
            var array = result.Split(" ".ToCharArray(), StringSplitOptions.RemoveEmptyEntries);
            if (array[0] == "1")
            {
                throw new Exception(array[1]);
            }
            if (File.Exists(file))
            {
                var dtostr = File.ReadAllText(file);
                list = Newtonsoft.Json.JsonConvert.DeserializeObject<List<DtoLinePoint>>(dtostr);
            }
            var Lines = list.Select(s => (s.Lon, s.Lat));
            return Lines;
        }

        /// <summary>
        /// 星地双星时差线
        /// </summary>
        /// <param name="opt"></param>
        /// <returns></returns>
        public static IEnumerable<(double lon, double lat)> DtoLineXDTwoStart(DtoLineTwoStartOption opt)
        {

            List<DtoLinePoint> list = new List<DtoLinePoint>();
            IntPtr LOP_ValuePtr;
            int LOP_Len = 0;


            CurveByTwoTDOA(
                opt.MsEph,
                 opt.NsEph,
                 opt.MsAnt,
                 opt.NsAnt,
                opt.RefGeod,
                 zone,
                opt.TargetDto * 1e-6,
                opt.RefDto * 1e-6, out LOP_ValuePtr, ref LOP_Len);


            double[] LOP_Value = new double[LOP_Len * 3];
            if (LOP_Len > 0)
            {
                Marshal.Copy(LOP_ValuePtr, LOP_Value, 0, LOP_Value.Length);

                list = OutputHelper.WriteDtoLine(LOP_Value, LOP_Len);
            }
            var Lines = list.Select(p => (p.Lon, p.Lat));
            return Lines;
        }

        private static IEnumerable<(double lon, double lat)> ParseResult(IntPtr LOP_ValuePtr, int LOP_Len)
        {
            List<DtoLinePoint> list = new List<DtoLinePoint>();
            double[] LOP_Value = new double[LOP_Len * 3];
            if (LOP_Len > 0)
            {
                Marshal.Copy(LOP_ValuePtr, LOP_Value, 0, LOP_Value.Length);
                for (int idx = 0; idx < LOP_Len; ++idx)
                {
                    if (LOP_Value[3 * idx + 1] != -1)
                    {
                        list.Add(new DtoLinePoint()
                        {
                            Lon = LOP_Value[3 * idx + 1],
                            Lat = LOP_Value[3 * idx]
                        });
                    }
                }
                for (int idx = 0; idx < LOP_Len; ++idx)
                {
                    if (LOP_Value[3 * idx + 2] != -1)
                    {
                        list.Add(new DtoLinePoint()
                        {
                            Lon = LOP_Value[3 * idx + 2],
                            Lat = LOP_Value[3 * idx]
                        });
                    }
                }
            }
            var Lines = list.Select(p => (p.Lon, p.Lat));
            return Lines;
        }


    }
}