借助网络配置,控制Modbus工具的日志显示,避免卡死界面
智能大石头 authored at 2021-12-11 22:09:19
5.14 KiB
XCoder
using System;
using NewLife;

namespace NewLife.XCoder.Tools.Coord;

/// <summary>坐标系转换:WGS84 / GCJ02(火星) / BD09(百度)</summary>
public static class CoordConverter
{
    private const Double Pi = 3.1415926535897932384626;
    private const Double A = 6378245.0;
    private const Double Ee = 0.00669342162296594323;

    /// <summary>判断是否在中国境外(境外不做偏移)</summary>
    /// <param name="lng">经度</param>
    /// <param name="lat">纬度</param>
    public static Boolean OutOfChina(Double lng, Double lat) => lng < 72.004 || lng > 137.8347 || lat < 0.8293 || lat > 55.8271;

    /// <summary>WGS84 转 GCJ02</summary>
    /// <param name="lng">经度</param>
    /// <param name="lat">纬度</param>
    public static (Double Lng, Double Lat) Wgs84ToGcj02(Double lng, Double lat)
    {
        if (OutOfChina(lng, lat)) return (lng, lat);

        var dLat = TransformLat(lng - 105.0, lat - 35.0);
        var dLng = TransformLng(lng - 105.0, lat - 35.0);

        var radLat = lat / 180.0 * Pi;
        var magic = Math.Sin(radLat);
        magic = 1 - Ee * magic * magic;
        var sqrtMagic = Math.Sqrt(magic);

        dLat = dLat * 180.0 / ((A * (1 - Ee)) / (magic * sqrtMagic) * Pi);
        dLng = dLng * 180.0 / (A / sqrtMagic * Math.Cos(radLat) * Pi);

        return (lng + dLng, lat + dLat);
    }

    /// <summary>GCJ02 转 WGS84(迭代逼近)</summary>
    /// <param name="lng">经度</param>
    /// <param name="lat">纬度</param>
    public static (Double Lng, Double Lat) Gcj02ToWgs84(Double lng, Double lat)
    {
        if (OutOfChina(lng, lat)) return (lng, lat);

        var wgsLng = lng;
        var wgsLat = lat;
        for (var i = 0; i < 3; i++)
        {
            var gcj = Wgs84ToGcj02(wgsLng, wgsLat);
            wgsLng += lng - gcj.Lng;
            wgsLat += lat - gcj.Lat;
        }

        return (wgsLng, wgsLat);
    }

    /// <summary>GCJ02 转 BD09</summary>
    /// <param name="lng">经度</param>
    /// <param name="lat">纬度</param>
    public static (Double Lng, Double Lat) Gcj02ToBd09(Double lng, Double lat)
    {
        var z = Math.Sqrt(lng * lng + lat * lat) + 0.00002 * Math.Sin(lat * Pi * 3000.0 / 180.0);
        var theta = Math.Atan2(lat, lng) + 0.000003 * Math.Cos(lng * Pi * 3000.0 / 180.0);

        return (z * Math.Cos(theta) + 0.0065, z * Math.Sin(theta) + 0.006);
    }

    /// <summary>BD09 转 GCJ02</summary>
    /// <param name="lng">经度</param>
    /// <param name="lat">纬度</param>
    public static (Double Lng, Double Lat) Bd09ToGcj02(Double lng, Double lat)
    {
        var x = lng - 0.0065;
        var y = lat - 0.006;
        var z = Math.Sqrt(x * x + y * y) - 0.00002 * Math.Sin(y * Pi * 3000.0 / 180.0);
        var theta = Math.Atan2(y, x) - 0.000003 * Math.Cos(x * Pi * 3000.0 / 180.0);

        return (z * Math.Cos(theta), z * Math.Sin(theta));
    }

    /// <summary>任意两种坐标系之间转换</summary>
    /// <param name="lng">经度</param>
    /// <param name="lat">纬度</param>
    /// <param name="from">源坐标系:WGS84 / GCJ02 / BD09</param>
    /// <param name="to">目标坐标系:WGS84 / GCJ02 / BD09</param>
    public static (Double Lng, Double Lat) Convert(Double lng, Double lat, String from, String to)
    {
        from = Normalize(from);
        to = Normalize(to);
        if (from == to) return (lng, lat);

        // 统一先转到 GCJ02,再转到目标
        var (gcjLng, gcjLat) = from switch
        {
            "WGS84" => Wgs84ToGcj02(lng, lat),
            "BD09" => Bd09ToGcj02(lng, lat),
            _ => (lng, lat),
        };

        return to switch
        {
            "WGS84" => Gcj02ToWgs84(gcjLng, gcjLat),
            "BD09" => Gcj02ToBd09(gcjLng, gcjLat),
            _ => (gcjLng, gcjLat),
        };
    }

    /// <summary>标准化坐标系名称</summary>
    /// <param name="name">名称</param>
    public static String Normalize(String name)
    {
        if (name.IsNullOrEmpty()) return "WGS84";

        return name.Trim().ToUpperInvariant() switch
        {
            "WGS84" or "WGS-84" or "GPS" => "WGS84",
            "GCJ02" or "GCJ-02" or "火星" or "AMAP" => "GCJ02",
            "BD09" or "BD-09" or "BAIDU" or "BD09LL" => "BD09",
            _ => "WGS84",
        };
    }

    private static Double TransformLat(Double x, Double y)
    {
        var 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;
    }

    private static Double TransformLng(Double x, Double y)
    {
        var 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;
    }
}