A Square Root Unscented Kalman Filter for visual monoSLAM

This paper introduces a square root unscented Kalman filter (SRUKF) solution to the problem of performing visual simultaneous localization and mapping (SLAM) using a single camera. Several authors have proposed the conventional UKF for SLAM to improve the handling of non-linearities compared with the more widely used EKF, but at the expense increasing computational complexity from O(N²) to O(N³) in the map size, making it unattractive for video-rate application. Van der Merwe and Wan´s general SRUKF delivers identical results to a general UKF along with computational savings, but remains O(N³) overall. This paper shows how the SRUKF for the SLAM problem can be re-posed with O(N²) complexity, matching that of the EKF. The paper also shows how the method of inverse depth feature initialization developed by Montiel et al. for the EKF can be reformulated to work with the SRUKF. Experimental results confirm that the SRUKF and the UKF produce identical estimates, and that the SRUKF is more consistent than the EKF. Although the complexity is the same, the SRUKF remains more expensive to compute.