(转)根据经纬度计算方位距离

Posted zhd_七

tags:

篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了(转)根据经纬度计算方位距离相关的知识,希望对你有一定的参考价值。

 

(原文地址:http://www.cnblogs.com/leejuan/p/5552460.html)

 

1.根据两点经纬度计算其间距离,发现有3种公式,结果区别不是很大。

2.根据一点的经纬度与到另外一点的距离、方位角,计算另一点的经纬度,误差不是很大。

  1 /** 
  2  *  
  3  * 计算经纬度、距离、方位角 
  4  *  
  5  * */  
  6 public class CalculationLogLatDistance {  
  7     /** 
  8      * 地球赤道半径(km) 
  9      * */  
 10     public final static double EARTH_RADIUS = 6378.137;  
 11     /** 
 12      * 地球每度的弧长(km) 
 13      * */  
 14     public final static double EARTH_ARC = 111.199;  
 15   
 16     /** 
 17      * 转化为弧度(rad) 
 18      * */  
 19     public static double rad(double d) {  
 20         return d * Math.PI / 180.0;  
 21     }  
 22   
 23     /** 
 24      * 求两经纬度距离 
 25      *  
 26      * @param lon1 
 27      *            第一点的经度 
 28      * @param lat1 
 29      *            第一点的纬度 
 30      * @param lon2 
 31      *            第二点的经度 
 32      * @param lat2 
 33      *            第二点的纬度 
 34      * @return 两点距离,单位km 
 35      * */  
 36     public static double GetDistanceOne(double lon1, double lat1, double lon2,  
 37             double lat2) {  
 38         double r1 = rad(lat1);  
 39         double r2 = rad(lon1);  
 40         double a = rad(lat2);  
 41         double b = rad(lon2);  
 42         double s = Math.acos(Math.cos(r1) * Math.cos(a) * Math.cos(r2 - b)  
 43                 + Math.sin(r1) * Math.sin(a))  
 44                 * EARTH_RADIUS;  
 45         return s;  
 46     }  
 47   
 48     /** 
 49      * 求两经纬度距离(google maps源码中) 
 50      *  
 51      * @param lon1 
 52      *            第一点的经度 
 53      * @param lat1 
 54      *            第一点的纬度 
 55      * @param lon2 
 56      *            第二点的经度 
 57      * @param lat2 
 58      *            第二点的纬度 
 59      * @return 两点距离,单位km 
 60      * */  
 61     public static double GetDistanceTwo(double lon1, double lat1, double lon2,  
 62             double lat2) {  
 63         double radLat1 = rad(lat1);  
 64         double radLat2 = rad(lat2);  
 65         double a = radLat1 - radLat2;  
 66         double b = rad(lon1) - rad(lon2);  
 67         double s = 2 * Math.asin(Math.sqrt(Math.pow(Math.sin(a / 2), 2)  
 68                 + Math.cos(radLat1) * Math.cos(radLat2)  
 69                 * Math.pow(Math.sin(b / 2), 2)));  
 70         s = s * EARTH_RADIUS;  
 71         return s;  
 72     }  
 73   
 74     /** 
 75      * 求两经纬度距离 
 76      *  
 77      * @param lon1 
 78      *            第一点的经度 
 79      * @param lat1 
 80      *            第一点的纬度 
 81      * @param lon2 
 82      *            第二点的经度 
 83      * @param lat2 
 84      *            第二点的纬度 
 85      * @return 两点距离,单位km 
 86      * */  
 87     public static double GetDistanceThree(double lon1, double lat1,  
 88             double lon2, double lat2) {  
 89         double radLat1 = rad(lat1);  
 90         double radLat2 = rad(lat2);  
 91         double radLon1 = rad(lon1);  
 92         double radLon2 = rad(lon2);  
 93         if (radLat1 < 0)  
 94             radLat1 = Math.PI / 2 + Math.abs(radLat1);// south  
 95         if (radLat1 > 0)  
 96             radLat1 = Math.PI / 2 - Math.abs(radLat1);// north  
 97         if (radLon1 < 0)  
 98             radLon1 = Math.PI * 2 - Math.abs(radLon1);// west  
 99         if (radLat2 < 0)  
100             radLat2 = Math.PI / 2 + Math.abs(radLat2);// south  
101         if (radLat2 > 0)  
102             radLat2 = Math.PI / 2 - Math.abs(radLat2);// north  
103         if (radLon2 < 0)  
104             radLon2 = Math.PI * 2 - Math.abs(radLon2);// west  
105         double x1 = Math.cos(radLon1) * Math.sin(radLat1);  
106         double y1 = Math.sin(radLon1) * Math.sin(radLat1);  
107         double z1 = Math.cos(radLat1);  
108   
109         double x2 = Math.cos(radLon2) * Math.sin(radLat2);  
110         double y2 = Math.sin(radLon2) * Math.sin(radLat2);  
111         double z2 = Math.cos(radLat2);  
112   
113         double d = Math.pow((x1 - x2), 2) + Math.pow((y1 - y2), 2)  
114                 + Math.pow((z1 - z2), 2);  
115         // // 余弦定理求夹角  
116         // double theta = Math.acos((2 - d) / 2);  
117   
118         d = Math.pow(EARTH_RADIUS, 2) * d;  
119         // //余弦定理求夹角  
120         double theta = Math.acos((2 * Math.pow(EARTH_RADIUS, 2) - d)  
121                 / (2 * Math.pow(EARTH_RADIUS, 2)));  
122   
123         double dist = theta * EARTH_RADIUS;  
124         return dist;  
125     }  
126   
127     /** 
128      * 求两经纬度方向角 
129      *  
130      * @param lon1 
131      *            第一点的经度 
132      * @param lat1 
133      *            第一点的纬度 
134      * @param lon2 
135      *            第二点的经度 
136      * @param lat2 
137      *            第二点的纬度 
138      * @return 方位角,角度(单位:°) 
139      * */  
140     public static double GetAzimuth(double lon1, double lat1, double lon2,  
141             double lat2) {  
142         lat1 = rad(lat1);  
143         lat2 = rad(lat2);  
144         lon1 = rad(lon1);  
145         lon2 = rad(lon2);  
146         double azimuth = Math.sin(lat1) * Math.sin(lat2) + Math.cos(lat1)  
147                 * Math.cos(lat2) * Math.cos(lon2 - lon1);  
148         azimuth = Math.sqrt(1 - azimuth * azimuth);  
149         azimuth = Math.cos(lat2) * Math.sin(lon2 - lon1) / azimuth;  
150         azimuth = Math.asin(azimuth) * 180 / Math.PI;  
151         if (Double.isNaN(azimuth)) {  
152             if (lon1 < lon2) {  
153                 azimuth = 90.0;  
154             } else {  
155                 azimuth = 270.0;  
156             }  
157         }  
158         return azimuth;  
159     }  
160   
161     /** 
162      * 已知一点经纬度A,和与另一点B的距离和方位角,求B的经纬度(计算结果有误) 
163      *  
164      * @param lon1 
165      *            A的经度 
166      * @param lat1 
167      *            A的纬度 
168      * @param distance 
169      *            AB距离(单位:米) 
170      * @param azimuth 
171      *            AB方位角 
172      * @return B的经纬度 
173      * */  
174     public static String GetOtherPoint(double lon1, double lat1,  
175             double distance, double azimuth) {  
176         azimuth = rad(azimuth);  
177         double ab = distance / EARTH_ARC;// AB间弧线长  
178         ab = rad(ab);  
179         double Lat = Math.asin(Math.sin(lat1) * Math.cos(ab) + Math.cos(lat1)  
180                 * Math.sin(ab) * Math.cos(azimuth));  
181         double Lon = lon1  
182                 + Math.asin(Math.sin(azimuth) * Math.sin(ab) / Math.cos(Lat));  
183         System.out.println(Lon + ”,” + Lat);  
184   
185         double a = Math.acos(Math.cos(90 - lon1) * Math.cos(ab)  
186                 + Math.sin(90 - lon1) * Math.sin(ab) * Math.cos(azimuth));  
187         double C = Math.asin(Math.sin(ab) * Math.sin(azimuth) / Math.sin(a));  
188         System.out.println(”c=” + C);  
189         double lon2 = lon1 + C;  
190         double lat2 = 90 - a;  
191         return lon2 + “,” + lat2;  
192     }  
193   
194     /** 
195      * 已知一点经纬度A,和与另一点B的距离和方位角,求B的经纬度 
196      *  
197      * @param lon1 
198      *            A的经度 
199      * @param lat1 
200      *            A的纬度 
201      * @param distance 
202      *            AB距离(单位:米) 
203      * @param azimuth 
204      *            AB方位角 
205      * @return B的经纬度 
206      * */  
207     public static String ConvertDistanceToLogLat(double lng1, double lat1,  
208             double distance, double azimuth) {  
209         azimuth = rad(azimuth);  
210         // 将距离转换成经度的计算公式  
211         double lon = lng1 + (distance * Math.sin(azimuth))  
212                 / (EARTH_ARC * Math.cos(rad(lat1)));  
213         // 将距离转换成纬度的计算公式  
214         double lat = lat1 + (distance * Math.cos(azimuth)) / EARTH_ARC;  
215         return lon + “,” + lat;  
216     }  
217   
218     public static void main(String[] args) {  
219         double lon1 = 121.469156;  
220         double lat1 = 31.232307;  
221         double lon2 = 121.469156;  
222         double lat2 = 31.233205;  
223         double distance = GetDistanceTwo(lon1, lat1, lon2, lat2);  
224         double azimuth = GetAzimuth(lon1, lat1, lon2, lat2);  
225         System.out.println(”经纬度为(“ + lon1 + “,” + lat1 + “)的点与经纬度为(“ + lon2  
226                 + ”,” + lat2 + “)相距:” + distance + “千米,” + “方位角:” + azimuth  
227                 + ”°”);  
228         System.out.println(”距经纬度为(“ + lon1 + “,” + lat1 + “)的点” + distance  
229                 + ”千米,方位角为” + azimuth + “°的另一点经纬度为(“  
230                 + ConvertDistanceToLogLat(lon1, lat1, distance, azimuth) + ”)”);  
231     }  
232 }  
233 [java] view plain copy
234 
235  
236 /** 
237  *  
238  * 计算经纬度、距离、方位角 
239  *  
240  * */  
241 public class CalculationLogLatDistance {  
242     /** 
243      * 地球赤道半径(km) 
244      * */  
245     public final static double EARTH_RADIUS = 6378.137;  
246     /** 
247      * 地球每度的弧长(km) 
248      * */  
249     public final static double EARTH_ARC = 111.199;  
250   
251     /** 
252      * 转化为弧度(rad) 
253      * */  
254     public static double rad(double d) {  
255         return d * Math.PI / 180.0;  
256     }  
257   
258     /** 
259      * 求两经纬度距离 
260      *  
261      * @param lon1 
262      *            第一点的经度 
263      * @param lat1 
264      *            第一点的纬度 
265      * @param lon2 
266      *            第二点的经度 
267      * @param lat2 
268      *            第二点的纬度 
269      * @return 两点距离,单位km 
270      * */  
271     public static double GetDistanceOne(double lon1, double lat1, double lon2,  
272             double lat2) {  
273         double r1 = rad(lat1);  
274         double r2 = rad(lon1);  
275         double a = rad(lat2);  
276         

以上是关于(转)根据经纬度计算方位距离的主要内容,如果未能解决你的问题,请参考以下文章

计算经纬度距离方位角

计算两个纬度坐标之间的距离/方位

PHP根据两点间的经纬度计算距离,php两点经纬度计算(转)

使用经纬度直接计算距离与方位角

已知基点的经纬度,根据方位角和运动距离求另外一点的经纬度

已知球面经纬度求方位角和反方位角(awk一行代码实现)