Robust Self-Contained Pedestrian Navigation by Fusing the IMU and Compass Measurements via UFIR Filtering

Algorithm 1

Kalman filter algorithm for the self-contained scheme.

Data: , , , ,

Result:

(1) begin

(2)for do

(3)

(4)

(5)

(6)

(7)

(8)end for

(9) end