ECEF坐标系转经纬度 wgs84 - 方法提炼

本文提供坐标系转换算法，根据某前端算法修改完善为C#语言支持。

最近在项目中遇到空间坐标转换问题，现提供相关算法C#支持。

源代码

相关代码如下：

using System;

namespace ConsoleApp1
{
    /// <summary>
    /// ECEF坐标系转换经纬度 wgs84
    /// 方法提炼
    /// </summary>
    internal class Program
    {
        private static void Main(string[] args)
        {
            double[] ret = XYZ2LLA(new double[]
            {
                3333,4444,1500
            });

            Console.WriteLine(string.Format("LON-:{0}\r\nLAT-:{1}\r\nALT-:{2}\r\n", ret[0], ret[1], ret[2]));
            
            Console.Read();
        }

        private static double EARTH_1 = 6378.137;
        private static double Temp_1 = EARTH_1 * (1.0 - (1.0 / 298.257223563));
        private static double Eccsq = 1 - Math.Pow(Temp_1, 2) / Math.Pow(EARTH_1, 2);
        private static double Dtr = Math.PI / 180.0;

        /// <summary>
        /// ECEF坐标系转经纬度 wgs84
        /// 输入-千米、千米、千米
        /// 输出-经、纬、千米
        /// </summary>
        /// <param name="xvec"></param>
        /// <returns></returns>
        private static double[] XYZ2LLA(double[] xvec)
        {
            double flatgc, flatn, dlat, rp, x, y, z, p, tangd, rn, clat, slat, flat, flon, altkm;
            x = xvec[0];
            y = xvec[1];
            z = xvec[2];

            rp = Math.Sqrt(Math.Pow(x, 2) + Math.Pow(y, 2) + Math.Pow(z, 2));
            flatgc = Math.Asin(z / rp) / Dtr;
            flon = ((Math.Abs(x) + Math.Abs(y)) < 1.0e-10) ? 0.0 : Math.Atan2(y, x) / Dtr;
            flon = (flon < 0.0) ? flon + 360.0 : flon;
            p = Math.Sqrt(Math.Pow(x, 2) + Math.Pow(y, 2));

            if (p < 1.0e-10)
            {
                flat = ((z < 0.0)) ? -90.0 : 90.0;
                altkm = rp - Radcur(flat)[0];
            }
            else
            {
                altkm = rp - Radcur(flatgc)[0];
                flat = Gc2gd(flatgc, altkm);
                rn = Radcur(flat)[1];
                for (double kount = 0; kount < 5; kount++)
                {
                    slat = Math.Sin(Dtr * flat);
                    tangd = (z + rn * Eccsq * slat) / p;
                    flatn = Math.Atan(tangd) / Dtr;
                    dlat = flatn - flat;
                    flat = flatn;
                    clat = Math.Cos(Dtr * flat);
                    rn = Radcur(flat)[1];
                    altkm = (p / clat) - rn;
                    if (Math.Abs(dlat) < 1.0e-12)
                    {
                        break;
                    }
                }
            }
            return new double[] { flat, flon, altkm };
        }

        private static double Gc2gd(double flatgci, double altkmi)
        {
            double[] rrnrm = Radcur(flatgci);
            double ratio = 1 - Math.Pow(Math.Sqrt(Eccsq), 2) * rrnrm[1] / (rrnrm[1] + altkmi);
            double tlat = Math.Tan(Dtr * flatgci) / ratio;
            rrnrm = Radcur((1 / Dtr) * Math.Atan(tlat));
            ratio = 1 - Math.Pow(Math.Sqrt(Eccsq), 2) * rrnrm[1] / (rrnrm[1] + altkmi);
            tlat = Math.Tan(Dtr * flatgci) / ratio;
            return (1 / Dtr) * Math.Atan(tlat);
        }

        private static double[] Radcur(double lati)
        {
            double slat, dsq, rn, rho, z;
            slat = Math.Sin(Dtr * lati);
            dsq = 1.0 - Eccsq * Math.Pow(slat, 2);
            rn = EARTH_1 / Math.Sqrt(dsq);
            rho = rn * Math.Cos(Dtr * lati);
            z = (1.0 - Eccsq) * rn * slat;
            return (new double[] { Math.Sqrt(Math.Pow(rho, 2) + Math.Pow(z, 2)), rn, rn * (1.0 - Eccsq) / dsq });
        }
    }
}
           

2019年11月25日

Dawn