Consistent Map-based 3D Localization on Mobile Devices
This work addresses localization challenges for mobile devices in mapped environments, offering incremental improvements in efficiency and accuracy.
The paper tackles the problem of providing consistent, real-time 3D localization on mobile devices by introducing the Cholesky-Schmidt-Kalman filter (C-SKF) and its relaxed version (sC-SKF), which reduce memory requirements from quadratic to linear in map size and bound processing needs, achieving competitive positioning accuracy compared to existing methods.
The objective of this paper is to provide consistent, real-time 3D localization capabilities to mobile devices navigating within previously mapped areas. To this end, we introduce the Cholesky-Schmidt-Kalman filter (C-SKF), which explicitly considers the uncertainty of the prior map, by employing the sparse Cholesky factor of the map's Hessian, instead of its dense covariance--as is the case for the Schmidt-Kalman filter (SKF). By doing so, the C-SKF has memory requirements typically linear in the size of the map, as opposed to quadratic for storing the map's covariance. Moreover, and in order to bound the processing needs of the C-SKF (between linear and quadratic in the size of the map), we introduce a relaxation of the C-SKF algorithm, the sC-SKF, which operates on the Cholesky factors of independent sub-maps resulting from dividing the trajectory and observations used for constructing the map into overlapping segments. Lastly, we assess the processing and memory requirements of the proposed C-SKF and sC-SKF algorithms, and compare their positioning accuracy against other approximate map-based localization approaches that employ measurement-noise-covariance inflation to compensate for the map's uncertainty.