explanation of EKF code required

2 Ansichten (letzte 30 Tage)
tehreem
tehreem am 14 Apr. 2012
can anyone provide explanation for the EKF code by Yi Cao
www.mathworks.com/matlabcentral/fileexchange/18189
n=4; %number of state q=0.1; %std of process r=0.1; %std of measurement Q=q^2*eye(n); % covariance of process % or Q=diag[Q 0]; % if no process noise is included in the parameter R=r^2; % covariance of measurement f=@(x)[x(2);x(3);x(4)*x(1)*(x(2)+x(3));x(4)]; % nonlinear state equations h=@(x)x(1); % measurement equation s=[0;0;1;0.1]; % initial state x=s+q*randn(4,1); %initial state % initial state with noise P = eye(n); % initial state covraiance N=20; % total dynamic steps xV = zeros(n,N); %estmate % allocate memory sV = zeros(n,N); %actual zV = zeros(1,N); for k=1:N z = h(s) + r*randn; % measurments sV(:,k)= s; % save actual state zV(k) = z; % save measurment [x, P] = ekf(f,x,P,h,z,Q,R); % ekf xV(:,k) = x; % save estimate s = f(s) + q*randn(3,1); % update process end;

Antworten (0)

Kategorien

Mehr zu Online Estimation finden Sie in Help Center und File Exchange

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by