dragacce.m

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

%DragAcce.m
%函数功能：计算阻力加速度
function result=DragAcce(CurrentState)
global g;
global Beta;
result=-0.5*g/Beta*Rho(CurrentState(3))*sqrt(CurrentState(2)^2+CurrentState(4)^2)*[CurrentState(2),CurrentState(4)]';