原文:https://blog.csdn.net/u013239236/article/details/52213661
感谢本篇算法的原作者,自己对代码做了点修改,但核心算法不变;
声明: 本文章只为记录跟解决作者自己在开发中遇到的问题。如有侵权,还望能及时联系。
需求是: 牧场 除草问题- 分区划分Id
翻译为:一个点(使用经纬度表示坐标)是否在一个多边形内部,多边形有多个点构成,每个点是一个实际的经纬度坐标,有多个点构成一个多边形。
/**
* 计算分区
* 2021年6月11日14:43:58
* wzq
* */
private Long calculationPartition(String x,String y){
long result = 99999;
//相对经纬度X,Y
String xRelative = "30.123456";
String yRelative = "21.123456";
//根据相对经纬x,y ;计算分别对应的实际的相对距离
double xDistance = getDistance(Double.valueOf(x), Double.parseDouble(xRelative));
double yDistance = getDistance(Double.valueOf(y), Double.parseDouble(yRelative));
//总面积 比如牧场面积
long xAxis = 1000;
long yAxis = 1000;
//扫描面积 比如单次除草面积
long xBit = 4;
long yBit = 4;
//向上取整
long xBlock = new BigDecimal(xAxis).divide(new BigDecimal(xBit),0, BigDecimal.ROUND_UP ).longValue();
//向上取整
long yBlock = new BigDecimal(yAxis).divide(new BigDecimal(yBit),0, BigDecimal.ROUND_UP ).longValue();
// x块 * y
//long allBlock = new BigDecimal(xBlock).multiply(new BigDecimal(yBlock)).setScale( 0, BigDecimal.ROUND_UP ).longValue();
long id = 1;
// 注意 注意 注意 看我循环,经纬度的顺序--》影响id 编号
for (int j = 0; j < yBlock; j++) {
for (int i = 0; i < xBlock; i++) {
//左下
Map<String, Double> map1 = new HashMap<String,Double>(2);
map1.put("px", Double.valueOf(xBit*i));
map1.put("py",Double.valueOf(yBit*(j+1)));
//左上
Map<String, Double> map2 = new HashMap<String,Double>(2);
map2.put("px", Double.valueOf(xBit*i));
map2.put("py", Double.valueOf(yBit*j));
//右上
Map<String, Double> map3 = new HashMap<String,Double>(2);
map3.put("px", Double.valueOf(xBit*(i+1)));
map3.put("py", Double.valueOf(yBit*j));
//右下
Map<String, Double> map4 = new HashMap<String,Double>(2);
map4.put("px", Double.valueOf(xBit*(i+1)));
map4.put("py", Double.valueOf(yBit*(j+1)));
//组成多边形!!
List<Map<String,Double>> areas = new ArrayList<Map<String,Double>>();
areas.add(map1);
areas.add(map2);
areas.add(map3);
areas.add(map4);
ArrayList<Double> polygonXa = new ArrayList<Double>();
ArrayList<Double> polygonYa = new ArrayList<Double>();
for (int k = 0; k < areas.size(); k++) {
Map<String, Double> map = areas.get(k);
polygonXa.add(map.get("px"));
polygonYa.add(map.get("py"));
}
//true在区域内,false不在区域内
Boolean flag = inPointInPolygon(xDistance, yDistance, polygonXa, polygonYa);
if(flag == true){
return id;
}else{
id++;
continue;
}
}
}
return result;
};
/**
* 判断目标点是否在多边形内(由多个点组成)
*
* @param px 目标点的经度坐标
* @param py 目标点的纬度坐标
* @param polygonXA 多边形的经度坐标集合
* @param polygonYA 多边形的纬度坐标集合
* @return 2021年6月11日14:43:58
*/
private boolean inPointInPolygon(double px, double py, ArrayList<Double> polygonXA, ArrayList<Double> polygonYA) {
boolean isInside = false;
double ESP = 1e-9;
int count = 0;
double linePoint1x;
double linePoint1y;
double linePoint2x = 180;
double linePoint2y;
linePoint1x = px;
linePoint1y = py;
linePoint2y = py;
for (int i = 0; i < polygonXA.size() - 1; i++) {
double cx1 = polygonXA.get(i);
double cy1 = polygonYA.get(i);
double cx2 = polygonXA.get(i + 1);
double cy2 = polygonYA.get(i + 1);
// 如果目标点在任何一条线上
if (isPointOnLine(px, py, cx1, cy1, cx2, cy2)) {
return true;
}
// 如果线段的长度无限小(趋于零)那么这两点实际是重合的,不足以构成一条线段
if (Math.abs(cy2 - cy1) < ESP) {
continue;
}
// 第一个点是否在以目标点为基础衍生的平行纬度线
if (isPointOnLine(cx1, cy1, linePoint1x, linePoint1y, linePoint2x, linePoint2y)) {
// 第二个点在第一个的下方,靠近赤道纬度为零(最小纬度)
if (cy1 > cy2){
count++;
}
}
// 第二个点是否在以目标点为基础衍生的平行纬度线
else if (isPointOnLine(cx2, cy2, linePoint1x, linePoint1y, linePoint2x, linePoint2y)) {
// 第二个点在第一个的上方,靠近极点(南极或北极)纬度为90(最大纬度)
if (cy2 > cy1) {
count++;
}
}
// 由两点组成的线段是否和以目标点为基础衍生的平行纬度线相交
else if (isIntersect(cx1, cy1, cx2, cy2, linePoint1x, linePoint1y, linePoint2x, linePoint2y)) {
count++;
}
}
if (count % 2 == 1) {
isInside = true;
}
return isInside;
}
/**
* 目标点是否在目标区域边上
*
* @param px0 目标点的经度坐标
* @param py0 目标点的纬度坐标
* @param px1 目标线的起点(终点)经度坐标
* @param py1 目标线的起点(终点)纬度坐标
* @param px2 目标线的终点(起点)经度坐标
* @param py2 目标线的终点(起点)纬度坐标
* @return 2021年6月11日14:43:58
*/
private boolean isPointOnLine(double px0, double py0, double px1, double py1, double px2, double py2) {
boolean flag = false;
// 无限小的正数
double ESP = 1e-9;
if ((Math.abs(Multiply(px0, py0, px1, py1, px2, py2)) < ESP) && ((px0 - px1) * (px0 - px2) <= 0)
&& ((py0 - py1) * (py0 - py2) <= 0)) {
flag = true;
}
return flag;
}
private double Multiply(double px0, double py0, double px1, double py1, double px2, double py2) {
return ((px1 - px0) * (py2 - py0) - (px2 - px0) * (py1 - py0));
}
/**
* 是否有 横断(横断的意思就是 4(n)个点的8(n*2)个坐标 的8(n*2)个数字(每个点都有横纵坐标)只要有任意两个数字(横和横比较纵和纵比较)相等,就是横断的意思)
* 参数为四个点的坐标
*/
private boolean isIntersect(double px1, double py1, double px2, double py2, double px3, double py3, double px4,
double py4) {
boolean flag = false;
double d = (px2 - px1) * (py4 - py3) - (py2 - py1) * (px4 - px3);
if (d != 0) {
double r = ((py1 - py3) * (px4 - px3) - (px1 - px3) * (py4 - py3)) / d;
double s = ((py1 - py3) * (px2 - px1) - (px1 - px3) * (py2 - py1)) / d;
if ((r >= 0) && (r <= 1) && (s >= 0) && (s <= 1)) {
flag = true;
}
}
return flag;
}
/**
* 计算两个经度之间的实际距离或两个纬度之间的实际距离
*/
public double getDistance(double lat, double lng) {
double radLat = rad(lat>lng?lat-lng:lng-lat);
double s = radLat;
s = s * 6378137;
s = Math.round(s * 10000) / 10000;
return s;
}
public double rad(double d) {
return d * Math.PI / 180.0;
}