潘钊 / control_gps_client · Commits

Commit bad0b9cbec7add9cfca073d94d2c6fad724eac77

Authored by 潘钊
1 parent fdcc0fc0

update...

Inline Side-by-side
Showing 4 changed files with 296 additions and 0 deletions
... ... @@ -93,6 +93,11 @@
93 93 <version>2.0.13</version>
94 94 </dependency>
95 95  
  96 + <dependency>
  97 + <groupId>com.vividsolutions</groupId>
  98 + <artifactId>jts</artifactId>
  99 + <version>1.13</version>
  100 + </dependency>
96 101 </dependencies>
97 102  
98 103 <build>
... ...
src/main/java/com/bsth/data/SectionDataHandle.java 0 → 100644
  View file @bad0b9c
  1 +package com.bsth.data;
  2 +
  3 +/**
  4 + * 路段相关处理
  5 + * Created by panzhao on 2017/7/16.
  6 + */
  7 +public class SectionDataHandle {
  8 +
  9 +
  10 +}
... ...
src/main/java/com/bsth/entity/Section.java 0 → 100644
  View file @bad0b9c
  1 +package com.bsth.entity;
  2 +
  3 +import com.alibaba.fastjson.JSON;
  4 +import com.alibaba.fastjson.JSONObject;
  5 +import com.fasterxml.jackson.annotation.JsonIgnore;
  6 +import com.vividsolutions.jts.geom.Coordinate;
  7 +import com.vividsolutions.jts.geom.GeometryFactory;
  8 +import com.vividsolutions.jts.geom.LineString;
  9 +
  10 +import java.util.ArrayList;
  11 +import java.util.List;
  12 +import java.util.Map;
  13 +
  14 +/**
  15 + * 路段信息
  16 + * Created by panzhao on 2017/4/5.
  17 + */
  18 +public class Section {
  19 +
  20 + public static List<Section> craete(List<Map<String, Object>> mapList){
  21 + List<Section> list = JSONObject.parseArray(JSON.toJSONString(mapList), Section.class);
  22 + //处理路段坐标
  23 + String polygonStr;
  24 + String[] coords;
  25 + int i, len;
  26 + String[] temps;//1, temps2;
  27 + List<Coordinate> cds;
  28 +
  29 + GeometryFactory geometryFactory = new GeometryFactory();
  30 + for(Section road : list){
  31 + polygonStr = road.getGROAD_VECTOR();
  32 + coords = polygonStr.substring(11, polygonStr.length() - 1).split(",");
  33 + len = coords.length;
  34 +
  35 + cds = new ArrayList<>();
  36 + //每2个点连一条线
  37 + for(i = 0; i < len; i ++){
  38 + temps = coords[i].split(" ");
  39 + cds.add(new Coordinate(Float.parseFloat(temps[1]), Float.parseFloat(temps[0])));
  40 + }
  41 +
  42 + Coordinate[] cdsArray = new Coordinate[cds.size()];
  43 + road.setLineStr(geometryFactory.createLineString(cds.toArray(cdsArray)));
  44 + }
  45 + return list;
  46 + }
  47 +
  48 + private long ID;
  49 +
  50 + @JsonIgnore
  51 + private String GROAD_VECTOR;
  52 +
  53 + private String ROAD_CODE;
  54 +
  55 + private String ROAD_NAME;
  56 +
  57 + private double SPEED;
  58 +
  59 + @JsonIgnore
  60 + private LineString lineStr;
  61 +
  62 + public long getID() {
  63 + return ID;
  64 + }
  65 +
  66 + public void setID(long ID) {
  67 + this.ID = ID;
  68 + }
  69 +
  70 + public String getGROAD_VECTOR() {
  71 + return GROAD_VECTOR;
  72 + }
  73 +
  74 + public void setGROAD_VECTOR(String GROAD_VECTOR) {
  75 + this.GROAD_VECTOR = GROAD_VECTOR;
  76 + }
  77 +
  78 + public String getROAD_CODE() {
  79 + return ROAD_CODE;
  80 + }
  81 +
  82 + public void setROAD_CODE(String ROAD_CODE) {
  83 + this.ROAD_CODE = ROAD_CODE;
  84 + }
  85 +
  86 + public String getROAD_NAME() {
  87 + return ROAD_NAME;
  88 + }
  89 +
  90 + public void setROAD_NAME(String ROAD_NAME) {
  91 + this.ROAD_NAME = ROAD_NAME;
  92 + }
  93 +
  94 + public double getSPEED() {
  95 + return SPEED;
  96 + }
  97 +
  98 + public void setSPEED(double SPEED) {
  99 + this.SPEED = SPEED;
  100 + }
  101 +
  102 + public LineString getLineStr() {
  103 + return lineStr;
  104 + }
  105 +
  106 + public void setLineStr(LineString lineStr) {
  107 + this.lineStr = lineStr;
  108 + }
  109 +}
... ...
src/main/java/com/bsth/util/GeoUtils.java 0 → 100644
  View file @bad0b9c
  1 +package com.bsth.util;
  2 +
  3 +import com.vividsolutions.jts.geom.Coordinate;
  4 +import com.vividsolutions.jts.geom.GeometryFactory;
  5 +import com.vividsolutions.jts.geom.LineString;
  6 +import com.vividsolutions.jts.geom.Point;
  7 +
  8 +/**
  9 + * Created by panzhao on 2016/12/23.
  10 + */
  11 +public class GeoUtils {
  12 +
  13 + private final static double EARTHRADIUS = 6378137;
  14 +
  15 + private static GeometryFactory geometryFactory = new GeometryFactory();
  16 +
  17 + public static double getDistance(Point p1, Point p2) {
  18 + double lng1 = getLoop(p1.getY(), -180, 180), lat1 = getRange(
  19 + p1.getX(), -74, 74);
  20 + double lng2 = getLoop(p2.getY(), -180, 180), lat2 = getRange(
  21 + p2.getX(), -74, 74);
  22 +
  23 + double x1, x2, y1, y2;
  24 + x1 = degreeToRad(lng1);
  25 + y1 = degreeToRad(lat1);
  26 + x2 = degreeToRad(lng2);
  27 + y2 = degreeToRad(lat2);
  28 + return EARTHRADIUS
  29 + * Math.acos((Math.sin(y1) * Math.sin(y2) + Math.cos(y1)
  30 + * Math.cos(y2) * Math.cos(x2 - x1)));
  31 + }
  32 +
  33 + private static double getLoop(double v, double a, double b) {
  34 + while (v > b) {
  35 + v -= b - a;
  36 + }
  37 + while (v < a) {
  38 + v += b - a;
  39 + }
  40 + return v;
  41 + }
  42 +
  43 + private static double getRange(double v, double a, double b) {
  44 + v = Math.min(Math.max(v, a), b);
  45 + return v;
  46 + }
  47 +
  48 + private static double degreeToRad(double degree) {
  49 + return Math.PI * degree / 180;
  50 + }
  51 +
  52 + /**
  53 + * 计算点 到 线的距离
  54 + * @param line
  55 + * @param p
  56 + * @return
  57 + */
  58 + public static double getDistanceFromLine(LineString line, Point p){
  59 + Point s = line.getStartPoint();
  60 + Point e = line.getEndPoint();
  61 + return getDistanceFromLine(s, e, p);
  62 + }
  63 +
  64 + public static double getDistanceFromLine(Point s, Point e, Point p){
  65 + double d1 = getDistance(s, p);
  66 + double d2 = getDistance(p, e);
  67 + double d3 = getDistance(s, e);
  68 + double distance = 0;
  69 +
  70 + double alpha = Math.acos((d1*d1 + d3*d3 - d2*d2)/(2*d1*d3));
  71 + double beta = Math.acos((d2*d2 + d3*d3 - d1*d1)/(2*d2*d3));
  72 +
  73 + if(alpha> Math.PI/2) {
  74 + distance = d1;
  75 + }
  76 + else if(beta > Math.PI/2) {
  77 + distance = d2;
  78 + }
  79 + else {
  80 + distance = Math.sin(alpha) * d1;
  81 + }
  82 + return distance;
  83 + }
  84 +
  85 + /**
  86 + * 计算2条直线的最短距离
  87 + * @param p1
  88 + * @param p2
  89 + * @param p3
  90 + * @param p4
  91 + * @return
  92 + */
  93 + public static double getDistanceLineToLine(Point p1, Point p2, Point p3, Point p4){
  94 + double distance;
  95 + double x1 = p1.getX(); //A点坐标（x1,y1,z1）
  96 + double y1 = p1.getY();
  97 + double z1 = 0;
  98 + double x2 = p2.getX(); //B点坐标（x2,y2,z2）
  99 + double y2 = p2.getY();
  100 + double z2 = 0;
  101 + double x3 = p3.getX(); //C点坐标（x3,y3,z3）
  102 + double y3 = p3.getY();
  103 + double z3 = 0;
  104 + double x4 = p4.getX(); //D点坐标（x4,y4,z4）
  105 + double y4 = p4.getY();
  106 + double z4 = 0;
  107 +
  108 + double a = (x2-x1)*(x2-x1)+(y2-y1)*(y2-y1)+(z2-z1)*(z2-z1);
  109 + double b = -((x2-x1)*(x4-x3)+(y2-y1)*(y4-y3)+(z2-z1)*(z4-z3));
  110 + double c = -((x1-x2)*(x1-x3)+(y1-y2)*(y1-y3)+(z1-z2)*(z1-z3));
  111 +
  112 + double d = -((x2-x1)*(x4-x3)+(y2-y1)*(y4-y3)+(z2-z1)*(z4-z3));
  113 + double e = (x4-x3)*(x4-x3)+(y4-y3)*(y4-y3)+(z4-z3)*(z4-z3);
  114 + double f = -((x1-x3)*(x4-x3)+(y1-y3)*(y4-y3)+(z1-z3)*(z4-z3));
  115 +
  116 + //平行
  117 + if ((a*e-b*d)==0&&(b*d-a*e)==0)
  118 + {
  119 + double d1 = getDistance(p1, p3);
  120 + double d2 = getDistance(p1, p4);
  121 + distance = (d1<d2)?d1:d2;
  122 + return distance;
  123 + }
  124 +
  125 + double s = (b*f-e*c)/(a*e-b*d);
  126 + double t = (a*f-d*c)/(b*d-a*e);
  127 +
  128 + //说明P点落在线段AB上,Q点落在线段CD上
  129 + if(0<=s&&s<=1&&0<=t&&t<=1)
  130 + {
  131 + //2条线段的公垂线段PQ;
  132 + //P点坐标
  133 + double X = x1+s*(x2-x1);
  134 + double Y = y1+s*(y2-y1);
  135 + double Z = z1+s*(z2-z1);
  136 + //Q点坐标
  137 + double U = x3+t*(x4-x3);
  138 + double V = y3+t*(y4-y3);
  139 + double W = z3+t*(z4-z3);
  140 + Point p = geometryFactory.createPoint(new Coordinate(X, Y, Z));
  141 + Point q = geometryFactory.createPoint(new Coordinate(U, V, W));
  142 + distance = getDistance(p, q);
  143 + }
  144 + else
  145 + {
  146 + double d1 = getDistanceFromLine(p3,p4,p1);
  147 + double d2 = getDistanceFromLine(p3,p4,p2);
  148 + double d3 = getDistanceFromLine(p1,p2,p3);
  149 + double d4 = getDistanceFromLine(p1,p2,p4);
  150 + distance = (d1<d2)?d1:d2;
  151 + distance = (distance<d3)?distance:d3;
  152 + distance = (distance<d4)?distance:d4;
  153 + }
  154 +
  155 + return distance;
  156 + }
  157 +
  158 + /**
  159 + * 计算点 到 线的垂直交点
  160 + * @param lp1
  161 + * @param lp2
  162 + * @param p
  163 + * @return
  164 + */
  165 + public static Point perpendularPoint(Point lp1, Point lp2, Point p){
  166 + double a = lp1.getX() - lp2.getX(), b = lp2.getY() - lp1.getY(), c = lp1.getY() * lp2.getX() - lp2.getY() * lp1.getX();
  167 + double lon = (Math.pow(b, 2) * p.getY() - a * b * p.getX() - a * c) / (Math.pow(a, 2) + Math.pow(b, 2));
  168 + double lat = (Math.pow(a, 2) * p.getX() - a * b * p.getY() - b * c) / (Math.pow(a, 2) + Math.pow(b, 2));
  169 +
  170 + return geometryFactory.createPoint(new Coordinate(lat, lon));
  171 + }
  172 +}
... ...