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
@Setter
public 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;
}
}