经纬度求距离求与正北方向的夹角（方向角）

转自：http://blog.youkuaiyun.com/liang5630/article/details/42775997

最近的工作需要这方面的计算，感觉还不错，收藏~

经纬度求距离求与正北方向的夹角（方向角），在网上看了好多这样的资料，许多算法感觉都不太对，今天终于找到个计算比较精准的，自己整理了下：

[java]  view plain copy

1. package com.liang.test;  
2.   
3. public class AngleUtil {  
4.   
5.     public static void main(String[] args) {  
6.         MyLatLng A=new MyLatLng(113.249648,23.401553);  
7.         MyLatLng B=new MyLatLng(113.246033,23.403362);  
8.         System.out.println(getAngle(A,B));  
9.     }  
10.     /** 
11.      * 求B点经纬度 
12.      * @param A 已知点的经纬度， 
13.      * @param distance   AB两地的距离  单位km 
14.      * @param angle  AB连线与正北方向的夹角（0~360） 
15.      * @return  B点的经纬度 
16.      */  
17.     public static MyLatLng getMyLatLng(MyLatLng A,double distance,double angle){  
18.           
19.         double dx = distance*1000*Math.sin(Math.toRadians(angle));  
20.         double dy= distance*1000*Math.cos(Math.toRadians(angle));  
21.           
22.         double bjd=(dx/A.Ed+A.m_RadLo)*180./Math.PI;  
23.         double bwd=(dy/A.Ec+A.m_RadLa)*180./Math.PI;  
24.         return new MyLatLng(bjd, bwd);  
25.     }  
26.       
27.     /** 
28.      * 获取AB连线与正北方向的角度 
29.      * @param A  A点的经纬度 
30.      * @param B  B点的经纬度 
31.      * @return  AB连线与正北方向的角度（0~360） 
32.      */  
33.     public  static double getAngle(MyLatLng A,MyLatLng B){  
34.         double dx=(B.m_RadLo-A.m_RadLo)*A.Ed;  
35.         double dy=(B.m_RadLa-A.m_RadLa)*A.Ec;  
36.         double angle=0.0;  
37.         angle=Math.atan(Math.abs(dx/dy))*180./Math.PI;    
38.         double dLo=B.m_Longitude-A.m_Longitude;  
39.         double dLa=B.m_Latitude-A.m_Latitude;  
40.         if(dLo>0&&dLa<=0){  
41.             angle=(90.-angle)+90;  
42.         }  
43.         else if(dLo<=0&&dLa<0){  
44.             angle=angle+180.;  
45.         }else if(dLo<0&&dLa>=0){  
46.             angle= (90.-angle)+270;  
47.         }  
48.         return angle;  
49.     }  
50.     static class MyLatLng {  
51.         final static double Rc=6378137;  
52.         final static double Rj=6356725;  
53.         double m_LoDeg,m_LoMin,m_LoSec;  
54.         double m_LaDeg,m_LaMin,m_LaSec;  
55.         double m_Longitude,m_Latitude;  
56.         double m_RadLo,m_RadLa;  
57.         double Ec;  
58.         double Ed;  
59.         public MyLatLng(double longitude,double latitude){  
60.             m_LoDeg=(int)longitude;  
61.             m_LoMin=(int)((longitude-m_LoDeg)*60);  
62.             m_LoSec=(longitude-m_LoDeg-m_LoMin/60.)*3600;  
63.               
64.             m_LaDeg=(int)latitude;  
65.             m_LaMin=(int)((latitude-m_LaDeg)*60);  
66.             m_LaSec=(latitude-m_LaDeg-m_LaMin/60.)*3600;  
67.               
68.             m_Longitude=longitude;  
69.             m_Latitude=latitude;  
70.             m_RadLo=longitude*Math.PI/180.;  
71.             m_RadLa=latitude*Math.PI/180.;  
72.             Ec=Rj+(Rc-Rj)*(90.-m_Latitude)/90.;  
73.             Ed=Ec*Math.cos(m_RadLa);  
74.         }  
75.     }  
76. }