本文主要是介绍PSINS工具箱自己优化的函数,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!
工具箱本身没有xyz的距离差转纬经高的差值的函数,根据工具箱现有函数名命名规则,编写一个demo,可能不是很严谨,但目前来说够用了。
用法
dxyz为xyz三轴的位移,pos0为初始纬经高。输出与初始点相比,纬经高的差值
程序源码
function [dpos] = EV_dxyz2dpos(dxyz,pos0)
% 笛卡尔系的xyz转化为纬经高
% See also pos2dxyz[RMh, clRNh] = RMRN(pos0(:,1:3));dlati = dxyz(2)/RMh;dlon = dxyz(1)/clRNh;dheight = dxyz(1);dpos = [dlati,dlon,dheight];
end
% ddxyz = [dpos(:,2).*clRNh, dpos(:,1).*RMh, dpos(:,3)];
这篇关于PSINS工具箱自己优化的函数的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!