经纬度坐标工具

LngLatUtil :用于计算里程数

import cn.hutool.core.util.ArrayUtil;
import com.alibaba.fastjson.JSON;
import com.alibaba.fastjson.JSONObject;
import lombok.Getter;
import lombok.Setter;import java.io.FileInputStream;
import java.io.Serializable;
import java.text.DecimalFormat;
import java.util.ArrayList;
import java.util.List;
import java.util.Objects;public class LngLatUtil {/*** 地球半径，m*/public static final double EARTH_RADIUS = 6371393d;/*** 偏离参考弧度大小*/public static final double OFFSET_RADIANS = Math.PI * 0.25d;public static double getRand(double min, double max) {double v = Math.random() * (max - min) + min;DecimalFormat df = new DecimalFormat("#0.00");return Double.parseDouble(df.format(v));}public static double getOffset(Point p1, Point p2) {// 纬度之差double a = Math.toRadians(p1.lat) - Math.toRadians(p2.lat);// 经度之差double b = Math.toRadians(p1.lng) - Math.toRadians(p2.lng);// 计算两点距离的公式double s = 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a / 2), 2) +Math.cos(p1.lat) * Math.cos(p2.lat) * Math.pow(Math.sin(b / 2), 2)));// 弧长乘地球半径, 返回单位: 米return s * EARTH_RADIUS;}public static Point offsetPoint(double lng, double lat, double offset, double radians) {Point point = new Point();if (offset > 0) {point.setLng(lng + offset * Math.sin(radians) * 180d / (Math.PI * EARTH_RADIUS * Math.cos(lat * Math.PI / 180d)));point.setLat(lat + offset * Math.cos(radians) / (Math.PI * EARTH_RADIUS / 180d));} else {point.setLng(lng);point.setLat(lng);}return point;}public static Point getNewPoint(Point samplePrev, Point sampleCur,int index) {double radians = 0d;if (Objects.nonNull(samplePrev)) {radians = getRadians(sampleCur, samplePrev);}radians = offsetRadians(radians);double offset;if(index > 0){offset = getRand(10, 50);}else{offset = getRand(150, 200);}return offsetPoint(sampleCur.lng, sampleCur.lat, offset, radians);}public static Point getNewPoint(Point prev, Point samplePrev, Point sampleCur) {double radians = 0d;if (Objects.nonNull(samplePrev)) {radians = getRadians(samplePrev, sampleCur);}radians = offsetRadians(radians);double offset = getRand(50, 100);if (Objects.isNull(prev)) {prev = sampleCur;}return offsetPoint(prev.lng, prev.lat, offset, radians);}public static double getRadians(Point p1, Point p2) {double y = Math.sin(p2.getLng() - p1.getLng()) * Math.cos(p2.getLat());double x = Math.cos(p1.getLat()) * Math.sin(p2.getLat()) - Math.sin(p1.getLat()) * Math.cos(p2.getLat()) * Math.cos(p2.getLng() - p1.getLng());return Math.atan2(y, x);}public static double offsetRadians(double radians) {double min = radians - OFFSET_RADIANS;double max = radians + OFFSET_RADIANS;return getRand(min, max);}@Getter@Setterpublic static class Point implements Serializable {private double lng;private double lat;}public static void main(String[] args) throws Exception {String path = "D:\\Desktop\\imei-data\\";FileInputStream fileInputStream = new FileInputStream(path + "4.json");byte[] bytes = new byte[1024];//每一次读取四个字节int readCount = 0;byte[] data = new byte[0];while ((readCount = fileInputStream.read(bytes)) != -1) {byte[] read = new byte[readCount];System.arraycopy(bytes, 0, read, 0, readCount);data = ArrayUtil.addAll(data, read);}String s = new String(data);List<Point> testData = JSONObject.parseArray(s, Point.class);Point samplePrev = null;List<Double[]> lines = new ArrayList<>();List<Double[]> origin = new ArrayList<>();for (int i = 0; i < testData.size(); i++) {Point sampleCur = testData.get(i);origin.add(new Double[]{sampleCur.lng, sampleCur.lat});Point p = getNewPoint(samplePrev, sampleCur, i);lines.add(new Double[]{p.lng, p.lat});samplePrev = sampleCur;}
//        System.out.println(JSON.toJSONString(origin));System.out.println();System.out.println(JSON.toJSONString(lines));}
}

CoordinateTransformUtils ： 坐标转换工具 BD09 、GCJ02、WGS84

/*** 百度坐标（BD09）、国测局坐标（火星坐标，GCJ02）、和WGS84坐标系之间的转换的工具** @see 参考https://github.com/wandergis/coordtransform实现的Java版本* @author geosmart*/
public class CoordinateTransformUtils {static double x_pi = 3.14159265358979324 * 3000.0 / 180.0;// πstatic double pi = 3.1415926535897932384626;// 长半轴static double a = 6378245.0;// 扁率static double ee = 0.00669342162296594323;/*** 百度坐标系(BD-09)转WGS坐标** @param lng 百度坐标纬度* @param lat 百度坐标经度* @return WGS84坐标数组*/public static double[] bd09towgs84(double lng, double lat) {double[] gcj = bd09togcj02(lng, lat);double[] wgs84 = gcj02towgs84(gcj[0], gcj[1]);return wgs84;}/*** WGS坐标转百度坐标系(BD-09)** @param lng WGS84坐标系的经度* @param lat WGS84坐标系的纬度* @return 百度坐标数组*/public static double[] wgs84tobd09(double lng, double lat) {double[] gcj = wgs84togcj02(lng, lat);double[] bd09 = gcj02tobd09(gcj[0], gcj[1]);return bd09;}/*** 火星坐标系(GCJ-02)转百度坐标系(BD-09)* 谷歌、高德——>百度** @param lng 火星坐标经度* @param lat 火星坐标纬度* @return 百度坐标数组*/public static double[] gcj02tobd09(double lng, double lat) {double z = Math.sqrt(lng * lng + lat * lat) + 0.00002 * Math.sin(lat * x_pi);double theta = Math.atan2(lat, lng) + 0.000003 * Math.cos(lng * x_pi);double bd_lng = z * Math.cos(theta) + 0.0065;double bd_lat = z * Math.sin(theta) + 0.006;return new double[]{bd_lng, bd_lat};}/*** 百度坐标系(BD-09)转火星坐标系(GCJ-02)* 百度——>谷歌、高德** @param bd_lon 百度坐标纬度* @param bd_lat 百度坐标经度* @return 火星坐标数组*/public static double[] bd09togcj02(double bd_lon, double bd_lat) {double x = bd_lon - 0.0065;double y = bd_lat - 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);double gg_lng = z * Math.cos(theta);double gg_lat = z * Math.sin(theta);return new double[]{gg_lng, gg_lat};}/*** WGS84转GCJ02(火星坐标系)** @param lng WGS84坐标系的经度* @param lat WGS84坐标系的纬度* @return 火星坐标数组*/public static double[] wgs84togcj02(double lng, double lat) {if (out_of_china(lng, lat)) {return new double[]{lng, lat};}double dlat = transformlat(lng - 105.0, lat - 35.0);double dlng = transformlng(lng - 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) / ((a * (1 - ee)) / (magic * sqrtmagic) * pi);dlng = (dlng * 180.0) / (a / sqrtmagic * Math.cos(radlat) * pi);double mglat = lat + dlat;double mglng = lng + dlng;return new double[]{mglng, mglat};}/*** GCJ02(火星坐标系)转GPS84** @param lng 火星坐标系的经度* @param lat 火星坐标系纬度* @return WGS84坐标数组*/public static double[] gcj02towgs84(double lng, double lat) {if (out_of_china(lng, lat)) {return new double[]{lng, lat};}double dlat = transformlat(lng - 105.0, lat - 35.0);double dlng = transformlng(lng - 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) / ((a * (1 - ee)) / (magic * sqrtmagic) * pi);dlng = (dlng * 180.0) / (a / sqrtmagic * Math.cos(radlat) * pi);double mglat = lat + dlat;double mglng = lng + dlng;return new double[]{lng * 2 - mglng, lat * 2 - mglat};}/*** 纬度转换** @param lng* @param lat* @return*/public static double transformlat(double lng, double lat) {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));ret += (20.0 * Math.sin(6.0 * lng * pi) + 20.0 * Math.sin(2.0 * lng * pi)) * 2.0 / 3.0;ret += (20.0 * Math.sin(lat * pi) + 40.0 * Math.sin(lat / 3.0 * pi)) * 2.0 / 3.0;ret += (160.0 * Math.sin(lat / 12.0 * pi) + 320 * Math.sin(lat * pi / 30.0)) * 2.0 / 3.0;return ret;}/*** 经度转换** @param lng* @param lat* @return*/public static double transformlng(double lng, double lat) {double ret = 300.0 + lng + 2.0 * lat + 0.1 * lng * lng + 0.1 * lng * lat + 0.1 * Math.sqrt(Math.abs(lng));ret += (20.0 * Math.sin(6.0 * lng * pi) + 20.0 * Math.sin(2.0 * lng * pi)) * 2.0 / 3.0;ret += (20.0 * Math.sin(lng * pi) + 40.0 * Math.sin(lng / 3.0 * pi)) * 2.0 / 3.0;ret += (150.0 * Math.sin(lng / 12.0 * pi) + 300.0 * Math.sin(lng / 30.0 * pi)) * 2.0 / 3.0;return ret;}/*** 判断是否在国内，不在国内不做偏移** @param lng* @param lat* @return*/public static boolean out_of_china(double lng, double lat) {if (lng < 72.004 || lng > 137.8347) {return true;} else if (lat < 0.8293 || lat > 55.8271) {return true;}return false;}
}