getdet.m

自己编写的鲁棒滤波算法的应用

function [DeTheta] = GetDeT(St,StJ)
%*****************************************************************
%************  经纬度计算误差引起的失准角 ************************
% St - 真实经纬度;  StJ - 解算经纬度;  DeTheta - 误差引起的失准角
%*****************************************************************
DeSt   =  StJ - St;            %经纬度误差
%*****************************************************************
% DeTheta = [-DePhe,  DeLamda*cos(Phe),  DeLamda*sin(Phe)]' 
DeTheta   =      [       -DeSt(2,:);
                   DeSt(1,:).*cos(St(2,:));
                   DeSt(1,:).*sin(St(2,:))  ];
%*****************************************************************