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