Combined extended FIR/Kalman filtering for indoor robot localization via triangulation

A combined unbiased finite impulse response (UFIR) and Kalman filtering algorithm is proposed for mobile robot localization via triangulation utilizing noisy measurements. We consider a mobile robot travelling on an indoor floorspace with three nodes in a view. Under the not well-known initial robot state and noise statistics, the extended Kalman filter (EKF) may produce unacceptable estimates. The iterative extended UFIR (EFIR) filter ignores the noise statistics, but requires N initial points of linear measurements which are unavailable. The combined EFIR/Kalman algorithm utilizes N first EKF estimates with approximately set initial conditions and noise statistics as linear measurements for EFIR filter. It is shown that the combined algorithm is more accurate than EKF in robot localization under the real operation conditions. Simulations are provided for piecewise and circular robot trajectories