1. package io.renren.utils;
  3. import org.springframework.stereotype.Component;
  5. /**
  6.  * 坐标经纬度工具类
  7.  * 百度坐标（BD09）、国测局坐标（火星坐标，GCJ02）、和WGS84坐标系之间的转换的工具
  8.  * 参考 https://github.com/wandergis/coordtransform 实现的Java版本
  9.  * @author geosmart
  10.  * @author WHN
  11.  */
  12. @Component
  13. public class CoordinateUtil {
  14.     static double x_pi = 3.14159265358979324 * 3000.0 / 180.0;
  15.     /**
  16.      * π
  17.      */
  18.     static double pi = 3.1415926535897932384626;
  19.     /**
  20.      * 长半轴
  21.      */
  22.     static double a = 6378245.0;
  23.     /**
  24.      * 扁率
  25.      */
  26.     static double ee = 0.00669342162296594323;
  27.     /**
  28.      * 平均半径,单位：m；不是赤道半径。赤道为6378左右
  29.      */
  30.     private static final double EARTH_RADIUS = 6371000;
  33.     /**
  34.      * 计算两个经纬度之间的距离，使用反余弦计算方式，火星坐标系
  35.      * @author WHN
  36.      * @date 2020/11/7 15:48
  37.      */
  38.     public static double gcj02CalculateDistance(double disX, double disY, double plotX, double plotY) {
  39.         double cos = Math.cos(Math.toRadians(disY)) * Math.cos(Math.toRadians(plotY)) * Math.cos(Math.toRadians(disX) - Math.toRadians(plotX))
  40.                 + Math.sin(Math.toRadians(disY)) * Math.sin(Math.toRadians(plotY));
  41.         // 反余弦值
  42.         double acos = Math.acos(cos);
  43.         return EARTH_RADIUS * acos;
  44.     }
  46.     /**
  47.      * 百度坐标系(BD-09)转WGS坐标
  48.      * @param lng 百度坐标纬度
  49.      * @param lat 百度坐标经度
  50.      * @return WGS84坐标数组
  51.      */
  52.     public static Double[] bd09towgs84(double lng, double lat) {
  53.         double[] gcj = bd09togcj02(lng, lat);
  54.         return gcj02towgs84(gcj[0], gcj[1]);
  55.     }
  57.     /**
  58.      * WGS坐标转百度坐标系(BD-09)
  59.      * @param lng WGS84坐标系的经度
  60.      * @param lat WGS84坐标系的纬度
  61.      * @return 百度坐标数组
  62.      */
  63.     public static double[] wgs84tobd09(double lng, double lat) {
  64.         double[] gcj = wgs84togcj02(lng, lat);
  65.         return gcj02tobd09(gcj[0], gcj[1]);
  66.     }
  68.     /**
  69.      * 火星坐标系(GCJ-02)转百度坐标系(BD-09)
  70.      * 谷歌、高德——>百度
  71.      * @param lng 火星坐标经度
  72.      * @param lat 火星坐标纬度
  73.      * @return 百度坐标数组
  74.      */
  75.     public static double[] gcj02tobd09(double lng, double lat) {
  76.         double z = Math.sqrt(lng * lng + lat * lat) + 0.00002 * Math.sin(lat * x_pi);
  77.         double theta = Math.atan2(lat, lng) + 0.000003 * Math.cos(lng * x_pi);
  78.         double bdLng = z * Math.cos(theta) + 0.0065;
  79.         double bdLat = z * Math.sin(theta) + 0.006;
  80.         return new double[] { bdLng, bdLat };
  81.     }
  83.     /**
  84.      * 百度坐标系(BD-09)转火星坐标系(GCJ-02)
  85.      * 百度——>谷歌、高德
  86.      * @param bd_lon 百度坐标纬度
  87.      * @param bd_lat 百度坐标经度
  88.      * @return 火星坐标数组
  89.      */
  90.     public static double[] bd09togcj02(double bd_lon, double bd_lat) {
  91.         double x = bd_lon - 0.0065;
  92.         double y = bd_lat - 0.006;
  93.         double z = Math.sqrt(x * x + y * y) - 0.00002 * Math.sin(y * x_pi);
  94.         double theta = Math.atan2(y, x) - 0.000003 * Math.cos(x * x_pi);
  95.         double gg_lng = z * Math.cos(theta);
  96.         double gg_lat = z * Math.sin(theta);
  97.         return new double[] { gg_lng, gg_lat };
  98.     }
  100.     /**
  101.      * WGS84转GCJ02(火星坐标系)
  102.      * @param lng WGS84坐标系的经度
  103.      * @param lat WGS84坐标系的纬度
  104.      * @return 火星坐标数组
  105.      */
  106.     public static double[] wgs84togcj02(double lng, double lat) {
  107.         if (outOfChina(lng, lat)) {
  108.             return new double[] { lng, lat };
  109.         }
  110.         double dlat = transformlat(lng - 105.0, lat - 35.0);
  111.         double dlng = transformlng(lng - 105.0, lat - 35.0);
  112.         double radlat = lat / 180.0 * pi;
  113.         double magic = Math.sin(radlat);
  114.         magic = 1 - ee * magic * magic;
  115.         double sqrtmagic = Math.sqrt(magic);
  116.         dlat = (dlat * 180.0) / ((a * (1 - ee)) / (magic * sqrtmagic) * pi);
  117.         dlng = (dlng * 180.0) / (a / sqrtmagic * Math.cos(radlat) * pi);
  118.         double mglat = lat + dlat;
  119.         double mglng = lng + dlng;
  120.         return new double[] { mglng, mglat };
  121.     }
  123.     /**
  124.      * GCJ02(火星坐标系)转GPS84
  125.      * @param lng 火星坐标系的经度
  126.      * @param lat 火星坐标系纬度
  127.      * @return WGS84坐标数组
  128.      */
  129.     public static Double[] gcj02towgs84(double lng, double lat) {
  130.         if (outOfChina(lng, lat)) {
  131.             return new Double[] { lng, lat };
  132.         }
  133.         double dlat = transformlat(lng - 105.0, lat - 35.0);
  134.         double dlng = transformlng(lng - 105.0, lat - 35.0);
  135.         double radlat = lat / 180.0 * pi;
  136.         double magic = Math.sin(radlat);
  137.         magic = 1 - ee * magic * magic;
  138.         double sqrtmagic = Math.sqrt(magic);
  139.         dlat = (dlat * 180.0) / ((a * (1 - ee)) / (magic * sqrtmagic) * pi);
  140.         dlng = (dlng * 180.0) / (a / sqrtmagic * Math.cos(radlat) * pi);
  141.         double mglat = lat + dlat;
  142.         double mglng = lng + dlng;
  143.         return new Double[] { lng * 2 - mglng, lat * 2 - mglat };
  144.     }
  146.     /**
  147.      * 纬度转换
  148.      * @param lng
  149.      * @param lat
  150.      */
  151.     public static double transformlat(double lng, double lat) {
  152.         double ret = -100.0 + 2.0 * lng + 3.0 * lat + 0.2 * lat * lat + 0.1 * lng * lat + 0.2 * Math.sqrt(Math.abs(lng));
  153.         ret += (20.0 * Math.sin(6.0 * lng * pi) + 20.0 * Math.sin(2.0 * lng * pi)) * 2.0 / 3.0;
  154.         ret += (20.0 * Math.sin(lat * pi) + 40.0 * Math.sin(lat / 3.0 * pi)) * 2.0 / 3.0;
  155.         ret += (160.0 * Math.sin(lat / 12.0 * pi) + 320 * Math.sin(lat * pi / 30.0)) * 2.0 / 3.0;
  156.         return ret;
  157.     }
  159.     /**
  160.      * 经度转换
  161.      * @param lng
  162.      * @param lat
  163.      */
  164.     public static double transformlng(double lng, double lat) {
  165.         double ret = 300.0 + lng + 2.0 * lat + 0.1 * lng * lng + 0.1 * lng * lat + 0.1 * Math.sqrt(Math.abs(lng));
  166.         ret += (20.0 * Math.sin(6.0 * lng * pi) + 20.0 * Math.sin(2.0 * lng * pi)) * 2.0 / 3.0;
  167.         ret += (20.0 * Math.sin(lng * pi) + 40.0 * Math.sin(lng / 3.0 * pi)) * 2.0 / 3.0;
  168.         ret += (150.0 * Math.sin(lng / 12.0 * pi) + 300.0 * Math.sin(lng / 30.0 * pi)) * 2.0 / 3.0;
  169.         return ret;
  170.     }
  172.     /**
  173.      * 判断是否在国内，不在国内不做偏移
  174.      * @param lng
  175.      * @param lat
  176.      */
  177.     public static boolean outOfChina(double lng, double lat) {
  178.         if (lng < 72.004 || lng > 137.8347) {
  179.             return true;
  180.         } else if (lat < 0.8293 || lat > 55.8271) {
  181.             return true;
  182.         }
  183.         return false;
  184.     }
  185. }

2.使用其中的反余弦计算经纬度距离方法：

  1. @Override
  2.     public List<Long> spatialQueryDeviceInDisaster(Double[] lnglat) {
  3.         Point point = new Point(lnglat[0], lnglat[1]);
  4.         Query query = new Query(Criteria.where("ZXDJDWD")
  5.                 .nearSphere(point).maxDistance(10000 / EARTH_RADIUS)
  6.                 .and("JSSJ").is(null)
  7.         );
  8.         List<DisasterEntity> disasterEntities = mongoTemplate.find(query, DisasterEntity.class);
  9.         List<Long> disidList = new ArrayList<>();
  10.         for (DisasterEntity disasterEntity : disasterEntities) {
  11.             double v = CoordinateUtil.gcj02CalculateDistance(point.getX(), point.getY(), disasterEntity.getZXDJDWD()[0], disasterEntity.getZXDJDWD()[1]);
  12.             if (v <= disasterEntity.getBJ()) {
  13.                 disidList.add(disasterEntity.getId());
  14.             }
  15.         }
  16.         return disidList;
  17.     }