int GeoLib::CalcDetailDistancePointToPoint( uint32 *Distance, const GeoLocation_t *LocationA, const GeoLocation_t *LocationB )//计算两点之间细节数据 { if(Distance == NULL || LocationA == NULL || LocationB == NULL) return FAILURE; int32 lAverageLat = (LocationA->latitude + LocationB->latitude)/2; uint32 lDx = 0; uint32 lDy =0; convertLongitudeDifferenceToDetailedMeter(&lDx,abs(LocationA->longitude-LocationB->longitude), lAverageLat);//计算两个地理位置的经度和纬度差的绝对值 convertLatitudeDifferenceToDetailedMeter(&lDy,abs(LocationA->latitude-LocationB->latitude), lAverageLat); Lib64bit_t stTmp1; Lib64bit_t stTmp2; mul64bitHalf(lDx, lDx, &stTmp1);//算平方,改写成64位 mul64bitHalf(lDy, lDy, &stTmp2); Lib_iAdd64(&stTmp1, &stTmp2);//算和 *Distance = Lib_calcSqrtOf64bit(stTmp1.High, stTmp1.Low);//开平方 return SUCCESS; }
时间: 2024-03-29 12:37:21 浏览: 41
lcm_driver.rar_176*220_lcm_液晶屏 单片机
这是一个计算地理坐标点之间距离的函数,使用的是勾股定理。其中,convertLongitudeDifferenceToDetailedMeter和convertLatitudeDifferenceToDetailedMeter函数用于将经纬度差转换成实际距离(单位为米),mul64bitHalf和Lib_iAdd64函数用于对实际距离进行计算。最后,将计算出的距离开平方得到最终结果(单位为米)。需要注意的是,该函数的输入参数为指向GeoLocation_t类型的指针,包含了地理位置的经度和纬度信息,返回值为成功或失败状态。
阅读全文