Input: , , , , , ,
       , , ,
  Output: ,
1   begin
2     ;
3    for     to  2  do
4       Call Kalman Filter Algorithm;
5     ;
6    Calculate   as in (6);
7     ;
8     Call Kalman Filter Algorithm;
Algorithm 3: The pre- and postfiltering algorithm (F-MB-F).