From: Iterative unbiased FIR state estimation: a review of algorithms
Stage
Given:
K, v=constant⩾0, q=n−v, n⩾K.
Set:
x ̂ K − 1 by (75) and G K−1 by (76) for m=0.
Update:
G n = [ H n T H n + ( F n G n − 1 F n T ) − 1 ] − 1 ,
x ̂ n = F n x ̂ n − 1 + G n H n T ( z n − H n F n x ̂ n − 1 ).
Compute x ̂ n − q for n>v as follows:
x ̂ n − q = B ̄ n , m (q) ( F n , 0 m + 1 ) − 1 x ̂ n .