添加点到线距离的方法

韩亚云
1 parent 63fcc83f
Showing 1 changed file with 51 additions and 3 deletions
moudle_pedometer/src/main/java/com/cnlive/moudle/pedometer/utils/MyMapUtil.java
@@ -3,18 +3,15 @@ package com.cnlive.moudle.pedometer.utils;
 import android.content.Context;
 import android.graphics.Bitmap;
 import android.graphics.BitmapFactory;
-import android.graphics.Color;
 import com.baidu.mapapi.map.BaiduMap;
 import com.baidu.mapapi.map.BitmapDescriptorFactory;
-import com.baidu.mapapi.map.Marker;
 import com.baidu.mapapi.map.MarkerOptions;
 import com.baidu.mapapi.map.Overlay;
 import com.baidu.mapapi.map.OverlayOptions;
 import com.baidu.mapapi.map.PolylineOptions;
 import com.baidu.mapapi.model.LatLng;
 import com.baidu.trace.model.SortType;
-import com.example.moudle_pedometer.R;
 import java.util.List;
@@ -385,4 +382,55 @@ public class MyMapUtil {
             return true;
         }
     }
+
+
+    /**
+     * luming
+     * 点到边的最短距离
+     * @param pointP
+     * @param pointA
+     * @param pointB
+     * @return
+     */
+    public static double minDistanceToLine(LatLng pointP, LatLng pointA, LatLng pointB){
+        double pa = getDistance(pointP,pointA);
+        double pb = getDistance(pointP,pointB);
+        double ab = getDistance(pointA,pointB);
+
+        if((Math.pow(pa,2) + Math.pow(ab,2)) <= Math.pow(pb,2) ){
+            return pa;
+        }
+        if((Math.pow(pb,2) + Math.pow(ab,2)) <= Math.pow(pa,2) ){
+            return pb;
+        }
+
+        double p = (pa + pb + ab) / 2 ;
+        double s = Math.sqrt(p*(p-pa)*(p-pb)*(p-ab));
+
+        return (2*s/ab);
+    }
+
+    /**
+     * 通过经纬度获取距离(单位：米)
+     * @param location1
+     * @param location2
+     * @return
+     */
+    public static double getDistance(LatLng location1,LatLng location2) {
+        double lat1 = location1.latitude;
+        double lat2 = location2.latitude;
+        double lng1 = location1.longitude;
+        double lng2 = location2.longitude;
+        double radLat1 = rad(lat1);
+        double radLat2 = rad(lat2);
+        double a = radLat1 - radLat2;
+        double b = rad(lng1) - rad(lng2);
+        double s = 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a / 2), 2)
+                + Math.cos(radLat1) * Math.cos(radLat2)
+                * Math.pow(Math.sin(b / 2), 2)));
+        s = s * EARTH_RADIUS;
+        s = Math.round(s * 10000d) / 10000d;
+        s = s*1000;
+        return s;
+    }
 }