1 <span style="font-size:14px;font-weight: normal;"> 2 private static final double EARTH_RADIUS = 6378137;//赤道半径(单位m) 3 4 /** 5 * 转化为弧度(rad) 6 * */ 7 private static double rad(double d) 8 { 9 return d * Math.PI / 180.0; 10 } 11 12 /** 13 * 基于余弦定理求两经纬度距离 14 * @param lon1 第一点的精度 15 * @param lat1 第一点的纬度 16 * @param lon2 第二点的精度 17 * @param lat3 第二点的纬度 18 * @return 返回的距离,单位km 19 * */ 20 public static double LantitudeLongitudeDist(double lon1, double lat1,double lon2, double lat2) { 21 double radLat1 = rad(lat1); 22 double radLat2 = rad(lat2); 23 24 double radLon1 = rad(lon1); 25 double radLon2 = rad(lon2); 26 27 if (radLat1 < 0) 28 radLat1 = Math.PI / 2 + Math.abs(radLat1);// south 29 if (radLat1 > 0) 30 radLat1 = Math.PI / 2 - Math.abs(radLat1);// north 31 if (radLon1 < 0) 32 radLon1 = Math.PI * 2 - Math.abs(radLon1);// west 33 if (radLat2 < 0) 34 radLat2 = Math.PI / 2 + Math.abs(radLat2);// south 35 if (radLat2 > 0) 36 radLat2 = Math.PI / 2 - Math.abs(radLat2);// north 37 if (radLon2 < 0) 38 radLon2 = Math.PI * 2 - Math.abs(radLon2);// west 39 double x1 = EARTH_RADIUS * Math.cos(radLon1) * Math.sin(radLat1); 40 double y1 = EARTH_RADIUS * Math.sin(radLon1) * Math.sin(radLat1); 41 double z1 = EARTH_RADIUS * Math.cos(radLat1); 42 43 double x2 = EARTH_RADIUS * Math.cos(radLon2) * Math.sin(radLat2); 44 double y2 = EARTH_RADIUS * Math.sin(radLon2) * Math.sin(radLat2); 45 double z2 = EARTH_RADIUS * Math.cos(radLat2); 46 47 double d = Math.sqrt((x1 - x2) * (x1 - x2) + (y1 - y2) * (y1 - y2)+ (z1 - z2) * (z1 - z2)); 48 //余弦定理求夹角 49 double theta = Math.acos((EARTH_RADIUS * EARTH_RADIUS + EARTH_RADIUS * EARTH_RADIUS - d * d) / (2 * EARTH_RADIUS * EARTH_RADIUS)); 50 double dist = theta * EARTH_RADIUS; 51 return dist; 52 } 53 </span>
时间: 2024-10-10 23:17:22