如何根据GPS坐标计算两地之间的距离

本文介绍了一种使用经纬度计算两点间距离的算法,通过将经纬度转换为弧度,并运用球面三角公式计算地球表面上任意两点间的最短路径。代码实现了从给定的经纬度坐标计算两点间距离的功能。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

#include <stdio.h>
#include <math.h>
           
#define     EARTH_RADIUS        6378137  //m
#define     PI                  3.1415926

static double rad(double d) //deg2rad
{
  return d * PI / 180.0;
}

struct gpsinfo
{
        double latitude;
        double longitude;
};

int main() 
{
        gpsinfo lastpos = {23.542879, 113.929671};
        gpsinfo nowpos = {23.542879, 113.929671};
        //gpsinfo nowpos =  {22.543299, 114.926437};

    double radLat1 = rad(lastpos.latitude);
    double radLat2 = rad(nowpos.latitude);
    double radLong1 = rad(lastpos.longitude);
    double radLong2 = rad(nowpos.longitude);
    
    double a = radLat1 - radLat2;
    double b = radLong1 - radLong2;
    double s = 2 * asin(sqrt(pow(sin(a/2),2) + cos(radLat1)*cos(radLat2)*pow(sin(b/2),2)));
    s = s * EARTH_RADIUS;
    s = round(s * 10000) / 10000;

    int distance = (int)s;
    printf("calcDistance %f,%f => %f,%f distance %dm\n", lastpos.latitude, lastpos.longitude, nowpos.latitude, nowpos.longitude, distance);
    
        return 0;
}
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值