GPS工具类(检测GPS信号.和GPS不同坐标系之间转换)

/***
 * 
 *    Title: MXFramework
 *           主题: GPS工具类
 *    Description: 
 *           功能:1.各种坐标系的转换
 *                2.计算两个经纬度的距离
 *                3.检查Gps信号
 *                4.经纬度合法性检测
 * 
 *    Date: 2019
 *    Version: v1.3.0版本
 *    Modify Recoder: 
 *      
 */

using System;
using UnityEngine;

namespace Mx.Util
{
    /// <summary>GPS工具类</summary>
    public class GPSUtil
    {
        //WGS-84:是国际标准,GPS坐标(Google Earth使用、或者GPS模块)
        //GCJ-02:中国坐标偏移标准,Google Map、高德、腾讯使用
        //BD-09 :百度坐标偏移标准,Baidu Map使用

        #region 数据申明

        public static LocationServiceStatus status;
        public static float desiredAccuracy = 70;

        #endregion

        #region 检测GPS信号

        public static void CheckGPS(out bool isOk, out string reasons)
        {
            bool success = false;
            string info = "GPS未知状态!";

            status = Input.location.status;

            if (status == LocationServiceStatus.Failed)
            {
                success = false;
                info = "未找到GPS信号!";
            }
            else if (status == LocationServiceStatus.Stopped)
            {
                success = false;
                info = "未找到GPS信号!";
            }
            else if (status == LocationServiceStatus.Initializing)
            {
                success = false;
                info = "等待GPS信号!";
            }
            else if (status == LocationServiceStatus.Running)
            {
                if (Input.location.lastData.horizontalAccuracy > desiredAccuracy)
                {
                    success = false;
                    info = "GPS信号微弱!";
                }
                else
                {
                    success = true;
                    info = "GPS信号OK!";
                }
            }

            isOk = success;
            reasons = info;
        }

扫描二维码关注公众号,回复: 8879512 查看本文章

        #endregion

        #region WGS-84、GCJ-02(火星坐标系)、BD-09(百度坐标系)之间的坐标转换器

        /// <summary>圆周率</summary>
        private const double PI = 3.1415926535897932384626;
        private const double X_PI = PI * 3000.0 / 180.0;

        /// <summary>
        /// 地理位置是否位于中国以外
        /// </summary>
        /// <param name="wgLat">WGS-84坐标纬度</param>
        /// <param name="wgLon">WGS-84坐标经度</param>
        /// <returns>  true:国外 false:国内
        /// </returns>
        public static bool OutOfChina(double wgLat, double wgLon)
        {
            if (wgLon < 72.004 || wgLon > 137.8347) return true;
            if (wgLat < 0.8293 || wgLat > 55.8271) return true;

            return false;
        }

        /// <summary>
        /// WGS-84坐标系转火星坐标系 (GCJ-02)
        /// </summary>
        /// <param name="wgLat">WGS-84坐标纬度</param>
        /// <param name="wgLon">WGS-84坐标经度</param>
        /// <param name="mgLat">输出:GCJ-02坐标纬度</param>
        /// <param name="mgLon">输出:GCJ-02坐标经度</param>
        public static void WGS84ToGCJ02(double wgLat, double wgLon, out double mgLat, out double mgLon)
        {
            if (OutOfChina(wgLat, wgLon))
            {
                mgLat = wgLat;
                mgLon = wgLon;
            }
            else
            {
                double dLat;
                double dLon;
                Delta(wgLat, wgLon, out dLat, out dLon);
                mgLat = wgLat + dLat;
                mgLon = wgLon + dLon;
            }
        }

        /// <summary>
        /// 火星坐标系 (GCJ-02)转WGS-84坐标系
        /// </summary>
        /// <param name="mgLat">GCJ-02坐标纬度</param>
        /// <param name="mgLon">GCJ-02坐标经度</param>
        /// <param name="wgLat">输出:WGS-84坐标纬度</param>
        /// <param name="wgLon">输出:WGS-84坐标经度</param>
        public static void GCJ02ToWGS84(double mgLat, double mgLon, out double wgLat, out double wgLon)
        {
            if (OutOfChina(mgLat, mgLon))
            {
                wgLat = mgLat;
                wgLon = mgLon;
            }
            else
            {
                double dLat;
                double dLon;
                Delta(mgLat, mgLon, out dLat, out dLon);
                wgLat = mgLat - dLat;
                wgLon = mgLon - dLon;
            }
        }

        /// <summary>
        /// 精准火星坐标系 (GCJ-02)转WGS-84坐标系
        /// </summary>
        /// <param name="mgLat">GCJ-02坐标纬度</param>
        /// <param name="mgLon">GCJ-02坐标经度</param>
        /// <param name="wgLat">输出:WGS-84坐标纬度</param>
        /// <param name="wgLon">输出:WGS-84坐标经度</param>
        public static void GCJ02ToWGS84Exact(double mgLat, double mgLon, out double wgLat, out double wgLon)
        {
            const double InitDelta = 0.01;
            const double Threshold = 0.000001;

            double dLat = InitDelta;
            double dLon = InitDelta;
            double mLat = mgLat - dLat;
            double mLon = mgLon - dLon;
            double pLat = mgLat + dLat;
            double pLon = mgLon + dLon;

            double nLat;
            double nLon;

            int i = 0;
            do
            {
                wgLat = (mLat + pLat) / 2;
                wgLon = (mLon + pLon) / 2;

                WGS84ToGCJ02(wgLat, wgLon, out nLat, out nLon);

                dLat = nLat - mgLat;
                dLon = nLon - mgLon;
                if ((Math.Abs(dLat) < Threshold) && (Math.Abs(dLon) < Threshold)) break;

                if (dLat > 0) pLat = wgLat; else mLat = wgLat;
                if (dLon > 0) pLon = wgLon; else mLon = wgLon;
            } while (++i <= 30);
        }

        /// <summary>
        /// 百度坐标系 (BD-09)转火星坐标系 (GCJ-02)
        /// </summary>
        /// <param name="bdLat">百度坐标系纬度</param>
        /// <param name="bdLon">百度坐标系经度</param>
        /// <param name="mgLat">输出:GCJ-02坐标纬度</param>
        /// <param name="mgLon">输出:GCJ-02坐标经度</param>         
        public static void BD09ToGCJ02(double bdLat, double bdLon, out double mgLat, out double mgLon)
        {
            double x = bdLon - 0.0065;
            double y = bdLat - 0.006;
            double z = Math.Sqrt(x * x + y * y) - 0.00002 * Math.Sin(y * X_PI);
            double theta = Math.Atan2(y, x) - 0.000003 * Math.Cos(x * X_PI);
            mgLat = z * Math.Sin(theta);
            mgLon = z * Math.Cos(theta);
        }

        /// <summary>
        /// 火星坐标系 (GCJ-02)转百度坐标系 (BD-09)
        /// </summary>
        /// <param name="mgLat">GCJ-02坐标纬度</param>
        /// <param name="mgLon">GCJ-02坐标经度</param>
        /// <param name="bdLat">输出:百度坐标系纬度</param>
        /// <param name="bdLon">输出:百度坐标系经度</param>
        public static void GCJ02ToBD09(double mgLat, double mgLon, out double bdLat, out double bdLon)
        {
            double x = mgLon;
            double y = mgLat;
            double z = Math.Sqrt(x * x + y * y) + 0.00002 * Math.Sin(y * X_PI);
            double theta = Math.Atan2(y, x) + 0.000003 * Math.Cos(x * X_PI);
            bdLat = z * Math.Sin(theta) + 0.006;
            bdLon = z * Math.Cos(theta) + 0.0065;
        }

        /// <summary>
        /// WGS-84坐标系转百度坐标系 (BD-09)
        /// </summary>
        /// <param name="wgLat">WGS-84坐标纬度</param>
        /// <param name="wgLon">WGS-84坐标经度</param>
        /// <param name="bdLat">输出:百度坐标系纬度</param>
        /// <param name="bdLon">输出:百度坐标系经度</param>
        public static void WGS84ToBD09(double wgLat, double wgLon, out double bdLat, out double bdLon)
        {
            double mgLat;
            double mgLon;

            WGS84ToGCJ02(wgLat, wgLon, out mgLat, out mgLon);
            GCJ02ToBD09(mgLat, mgLon, out bdLat, out bdLon);
        }

        /// <summary>
        /// 百度坐标系 (BD-09)转WGS-84坐标系
        /// </summary>
        /// <param name="bdLat">百度坐标系纬度</param>
        /// <param name="bdLon">百度坐标系经度</param>
        /// <param name="wgLat">输出:WGS-84坐标纬度</param>
        /// <param name="wgLon">输出:WGS-84坐标经度</param>
        public static void BD09ToWGS84(double bdLat, double bdLon, out double wgLat, out double wgLon)
        {
            double mgLat;
            double mgLon;

            BD09ToGCJ02(bdLat, bdLon, out mgLat, out mgLon);
            GCJ02ToWGS84(mgLat, mgLon, out wgLat, out wgLon);
        }

        /// <summary>
        /// 计算两点位置的距离,返回两点的距离,单位 米
        /// </summary>
        /// <returns>The distance.</returns>
        /// <param name="LatA">第一点纬度</param>
        /// <param name="LonA">第一点经度<</param>
        /// <param name="LatB">第二点纬度</param>
        /// <param name="LonB">第二点经度</param>
        public static double Distance(double LatA, double LonA, double LatB, double LonB)
        {
            const double EarthR = 6371000.0;

            double x = Math.Cos(LatA * PI / 180.0) * Math.Cos(LatB * PI / 180.0) * Math.Cos((LonA - LonB) * PI / 180);
            double y = Math.Sin(LatA * PI / 180.0) * Math.Sin(LatB * PI / 180.0);
            double s = x + y;
            if (s > 1) s = 1;
            if (s < -1) s = -1;

            return Math.Acos(s) * EarthR;
        }

        private static void Delta(double Lat, double Lon, out double dLat, out double dLon)
        {
            const double AXIS = 6378245.0;
            const double EE = 0.00669342162296594323;

            dLat = TransformLat(Lon - 105.0, Lat - 35.0);
            dLon = TransformLon(Lon - 105.0, Lat - 35.0);
            double radLat = Lat / 180.0 * PI;
            double magic = Math.Sin(radLat);
            magic = 1 - EE * magic * magic;
            double sqrtMagic = Math.Sqrt(magic);
            dLat = (dLat * 180.0) / ((AXIS * (1 - EE)) / (magic * sqrtMagic) * PI);
            dLon = (dLon * 180.0) / (AXIS / sqrtMagic * Math.Cos(radLat) * PI);
        }

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

        #endregion

        #region 验证经纬度

        /// <summary>  
        /// 验证经度  
        /// </summary>  
        /// <param name="input">待验证的字符串</param>  
        /// <returns>是否匹配</returns>  
        public static bool IsLongitude(string input)
        {
            ////范围为-180~180,小数位数必须是1到5位  
            //string pattern = @"^[-\+]?((1[0-7]\d{1}|0?\d{1,2})\.\d{1,5}|180\.0{1,5})$";  
            //return IsMatch(input, pattern);  
            float lon;
            if (float.TryParse(input, out lon) && lon >= -180 && lon <= 180)
                return true;
            else
                return false;
        }

        /// <summary>  
        /// 验证纬度  
        /// </summary>  
        /// <param name="input">待验证的字符串</param>  
        /// <returns>是否匹配</returns>  
        public static bool IsLatitude(string input)
        {
            ////范围为-90~90,小数位数必须是1到5位  
            //string pattern = @"^[-\+]?([0-8]?\d{1}\.\d{1,5}|90\.0{1,5})$";  
            //return IsMatch(input, pattern);  
            float lat;
            if (float.TryParse(input, out lat) && lat >= -90 && lat <= 90)
                return true;
            else return false;
        }

        #endregion


    }//Class_end
}

Unity QQ交流群:299412191 欢迎对Unity感兴趣的同学加入.

发布了16 篇原创文章 · 获赞 16 · 访问量 1824

猜你喜欢

转载自blog.csdn.net/a451319296/article/details/104073227
GPS