body2.m

来自「是卡尔曼滤波算法的源代码」· M 代码 · 共 11 行

function y=body2(x,w)
% Falling body example. Output equation.
persistent M H
if nargin==1,
  M = x(2);
  H = x(3);
else
  tmp = x(1)-H;
  y = sqrt(M*M+tmp*tmp)+w;
end