利用经纬度算距离与角度

public static double GetDistance(double long1, double lat1, double long2,  

        double lat2) {  

    double a, b, R;  

    R = 6378137; // 地球半径  

    lat1 = lat1 * Math.PI / 180.0;  

    lat2 = lat2 * Math.PI / 180.0;  

    a = lat1 - lat2;  

    b = (long1 - long2) * Math.PI / 180.0;  

    double d;  

    double sa2, sb2;  

    sa2 = Math.sin(a / 2.0);  

    sb2 = Math.sin(b / 2.0);  

    d = 2  

            * R  

            * Math.asin(Math.sqrt(sa2 * sa2 + Math.cos(lat1)  

                    * Math.cos(lat2) * sb2 * sb2));  

    return d;  

}

public static double getAngle(double lat_a, double lng_a, double lat_b, double lng_b)

{

  double d = 0;

  lat_a=lat_a*Math.PI/180;

  lng_a=lng_a*Math.PI/180;

  lat_b=lat_b*Math.PI/180;

  lng_b=lng_b*Math.PI/180;

         

  d=Math.sin(lat_a)*Math.sin(lat_b)+Math.cos(lat_a)*Math.cos(lat_b)*Math.cos(lng_b-lng_a);

  d=Math.sqrt(1-d*d);

  d=Math.cos(lat_b)*Math.sin(lng_b-lng_a)/d;

  d=Math.asin(d)*180/Math.PI;

//d = Math.round(d*10000);

  return d;

}

posted @ 2016-08-01 18:33  earthsou  阅读(966)  评论(0编辑  收藏  举报