通过两个点的经纬度坐标,计算偏北角算法

这段MATLAB代码实现了WGS84坐标系下经纬度到东北天坐标的转换,并计算了待测点相对于基准点的偏北角度。通过对经纬度数据的处理,代码适用于定位和导航系统中的方向计算。

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

以下是matlab代码
clc
clear all

reflat = [121.5579868206571 29.901759261705514 0];%基准点经纬度
lla = [121.5575941023510 29.901770103264110 0];%待测点经纬度
% reflat = [121.5575660045000 29.901662429833333 0];
% lla = [121.5580470217427 29.901685205115914 0];
pointNum = size(lla,1);%待测点个数
enu = zeros(pointNum,3);%待测点东北天坐标
northAngle = zeros(pointNum,1);%待测点偏北角

for i = 1:pointNum
enu(i,:) = Fun.wgslla2enu(lla(i,2), lla(i,1), lla(i,3), reflat(2), reflat(1), reflat(3));%待测点东北天坐标求取

if abs(enu(i,1)) < 0.0001
if enu(i,2) > 0
northAngle(i) = 0;
else
northAngle(i) = 180;
end
else
if enu(i,1) > 0
northAngle(i) = 90 - atand(enu(i,2)/enu(i,1)); %目标偏北角
else
northAngle(i) = 270 - atand(enu(i,2)/enu(i,1)); %目标偏北角
end
end
end

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值