project4.m

来自「这是zarchan书的fundamentals of kalman filter」· M 代码 · 共 14 行

function [XTH,XTDH]=project4(TP,TS,XTP,XTDP,HP,W)
T=0.;
XT=XTP;
XTD=XTDP;
H=HP;
while T<=(TS-.0001)
	XTDD=-W*W*XT;
	XTD=XTD+H*XTDD;
	XT=XT+H*XTD;
	T=T+H;
end
XTH=XT;
XTDH=XTD;