代码拉取完成,页面将自动刷新
同步操作将从 李雪健/GPS_Milemeter_IMU_EKFLocation 强制同步,此操作会覆盖自 Fork 仓库以来所做的任何修改,且无法恢复!!!
确定后同步将在后台操作,完成时将刷新页面,请耐心等待。
function BLH=XYZ_BLH(X,Y,Z)
% Transform the (X Y Z) into (B L H) under the WGS84 coordinate system
a=6378137.00; % 长半轴,全部参考WGS-84椭球参数表
b=6356752.3142; % 短半轴
alfa=1/298.257223563; % 扁率
e2=0.00669437999013; % 第一偏心率的平方
% L=atan(Y/X);
L=Azimuth(X,Y); % 经度,即水平方向方位角
N0=a;
H0=sqrt(X^2+Y^2+Z^2)-sqrt(a*b);
B0=atan(Z/sqrt(X^2+Y^2)/(1.0-e2*N0/(N0+H0)));
while(true)
N1=a/sqrt(1.0-e2*sin(B0)^2);
H1=sqrt(X^2+Y^2)/cos(B0)-N0;
B1=atan(Z/sqrt(X^2+Y^2)/(1.0-e2*N1/(N1+H1)));
if (abs(H1-H0)>0.001 & abs(B1-B0)>4.848132257047973e-11) % B的精度为0.00001"
N0=N1;
H0=H1;
B0=B1;
else
break;
end
end
BLH.B=B1;
BLH.L=L;
BLH.H=H1;
return
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。