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

const pi = 3.14159265358979324;
const a = 6378245.0;
const ee = 0.00669342162296594323;

/**
 * WGS84坐标转换GCJ02坐标
 * @param wgLat：wgs纬度
 * @param wgLon：wgs经度
 * @return Array[lat:gcj纬度,lon:gcj经度]
 */
export function Wgs84ToGcj02 (wgLat, wgLon){
  let mgLat, mgLon;
  if (!outOfChina(wgLat, wgLon)){
    mgLat = wgLat;
    mgLon = wgLon;
    return [wgLat,wgLon];
  }
  let dLat = transformLat(wgLon - 105.0, wgLat - 38.5);
  let dLon = transformLon(wgLon - 105.0, wgLat - 11.5);
  let radLat = wgLat / 180.0 * pi;
  let magic = Math.sin(radLat);
  magic = 1 - ee * magic * magic;
  let sqrtMagic = Math.sqrt(magic);
  dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
  dLon = (dLon * 180.0) / (a / sqrtMagic * Math.cos(radLat) * pi);
  mgLat = wgLat + dLat;
  mgLon = wgLon + dLon;
  let arr = {};
  arr['lat'] = mgLat;
  arr['lon'] = mgLon;
  console.log([wgLat, wgLon],'转换->',[mgLat,mgLon])
  return [mgLat,mgLon];
}
const outOfChina = function(lat,lon) {
  if (lon < 72.004 || lon > 137.8347)
    return true;
  return lat < 0.8293 || lat > 55.8271;

}
const transformLat = function(x, y){
  let ret = -100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y + 0.2 * Math.sqrt(Math.abs(x));
  ret += (20.0 * Math.sin(6.0 * x * pi) + 20.0 * Math.sin(2.0 * x * pi)) * 2.0 / 3.0;
  ret += (20.0 * Math.sin(y * pi) + 40.0 * Math.sin(y / 3.0 * pi)) * 2.0 / 3.0;
  ret += (160.0 * Math.sin(y / 12.0 * pi) + 320 * Math.sin(y * pi / 30.0)) * 2.0 / 3.0;
  return ret;
}
const transformLon = function(x, y){
  let ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1 * Math.sqrt(Math.abs(x));
  ret += (20.0 * Math.sin(6.0 * x * pi) + 20.0 * Math.sin(2.0 * x * pi)) * 2.0 / 3.0;
  ret += (20.0 * Math.sin(x * pi) + 40.0 * Math.sin(x / 3.0 * pi)) * 2.0 / 3.0;
  ret += (150.0 * Math.sin(x / 12.0 * pi) + 300.0 * Math.sin(x / 30.0 * pi)) * 2.0 / 3.0;
  return ret;
}