GPS算法

最新推荐文章于 2024-07-25 15:25:12 发布

BruceEirc

最新推荐文章于 2024-07-25 15:25:12 发布

阅读量1.6k

点赞数

分类专栏： GPS 文章标签： gps

GPS 专栏收录该内容

1 篇文章 0 订阅

订阅专栏

计算两个GPS坐标的距离

Posted on 2010-04-20 18:34 xuanfeng 阅读( 7347) 评论( 6) 编辑收藏

场景：已知两个GPS点的经纬度坐标信息。计算两点的距离。

1．距离/纬度关系

GPS: 22.514519,113.380301

GPS: 22.511962,113.380301

距离:284.6439379583341

jl_wd=284.6439379583341/(22.51451-22.511962)

=111712.69150641055729984301412873 (米/度)

2．距离/经度关系

GPS: 22.514866, 113.388444

GPS: 22.514866, 113.379378

距离: 932.2997762326453

jl_jd =932.2997762326453/(113.388444-113.379378)

=102834.74258026089786013677476285(米/度)

3．勾股定理

勾股定理:a²+b²=c²

看上图中已知道A，B的坐标后，就可以求得A点与B点的纬度差值的绝对值

wd_c=|(N1,-N2)|

A点与B点的经度差值的绝对值

jd_c=|(E2-E1)|

知道了经度、纬度和距离的关系，又知道了A点与B点的经度差和纬度差，那么就可以求出b的长度和a的长度,a和b求出来后就可以用直三角形的勾股定理求出c边的长度也就是A点也B点的距离。

b=wd_c*jl_wd

a=jd_c*jl_jd

c=√(a²+b²)

实现代码:

	//计算两点GPS坐标距离 
private const double EARTH_RADIUS = 6378.137;
private static double rad(double d)
{
   return d * Math.PI / 180.0;
}

public static double GetDistance(double lat1, double lng1, double lat2, double lng2)
{
   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 * 10000) / 10000;
   return s;
}

参考网址：http://www.cnblogs.com/xuanfeng/archive/2010/04/20/1716431.html