dragaccee.m

文件夹中NPFMain.m为滤波算法主运行程序

%DragAcceE.m
%功能：对扩展状态计算阻力加速度
function result=DragAcceE(CurrentState)
global g;

result=-0.5*g/CurrentState(5)*Rho(CurrentState(3))*sqrt(CurrentState(2)^2+CurrentState(4)^2)*[CurrentState(2),CurrentState(4)]';