Skip to content
Snippets Groups Projects
Commit ae72105b authored by ferhat's avatar ferhat
Browse files

Speeds up the Kalman smoother

parent 4e789452
Branches
Tags
1 merge request!5772 additional commits
...@@ -177,7 +177,7 @@ while notsteady && t<smpl ...@@ -177,7 +177,7 @@ while notsteady && t<smpl
atilde(:,t) = a(:,t) + PZI*v(di,t); atilde(:,t) = a(:,t) + PZI*v(di,t);
K(:,di,t) = T*PZI; K(:,di,t) = T*PZI;
L(:,:,t) = T-K(:,di,t)*ZZ; L(:,:,t) = T-K(:,di,t)*ZZ;
P(:,:,t+1) = T*P(:,:,t)*T'-T*P(:,:,t)*ZZ'*K(:,di,t)' + QQ; P(:,:,t+1) = T*P(:,:,t)*L(:,:,t)' + QQ;
end end
a(:,t+1) = T*atilde(:,t); a(:,t+1) = T*atilde(:,t);
Pf = P(:,:,t); Pf = P(:,:,t);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment