Skip to Main Content
This paper presents new algorithms to implement simultaneous localization and mapping in environments with very large numbers of features. The algorithms present an efficient solution to the full update required by the compressed extended Kalman filter algorithm. It makes use of the relative landmark representation to develop very close to optimal decorrelation solutions. With this approach, the memory and computational requirements are reduced from ∼O(N2) to ∼O(N*Na), N and Na proportional to the number of features in the map and features close to the vehicle, respectively. Experimental results are presented to verify the operation of the system when working in large outdoor environments.