The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences
Publications Copernicus
Articles | Volume XXXVIII-3/W22
Int. Arch. Photogramm. Remote Sens. Spatial Inf. Sci., XXXVIII-3/W22, 91–96, 2011
Int. Arch. Photogramm. Remote Sens. Spatial Inf. Sci., XXXVIII-3/W22, 91–96, 2011

  26 Apr 2013

26 Apr 2013


M. Kleinert1 and U. Stilla2 M. Kleinert and U. Stilla
  • 1Fraunhofer IOSB, Department Scene Analysis, Gutleuthausstr. 1, 76275 Ettlingen, Germany
  • 2Technische Universität München, Photogrammetry and Remote Sensing, Arcisstrasse 21, 80333 München, Germany

Keywords: Monocular SLAM, Inertial measurement system, Extended Kalman filter, Correlations, Estimation

Abstract. Repeated observation of several characteristically textured surface elements allows the reconstruction of the camera trajectory and a sparse point cloud which is often referred to as "map". The extended Kalman filter (EKF) is a popular method to address this problem, especially if real-time constraints have to be met. Inertial measurements as well as a parameterization of the state vector that conforms better to the linearity assumptions made by the EKF may be employed to reduce the impact of linearization errors. Therefore, we adopt an inertial-aided monocular SLAM approach where landmarks are parameterized in inverse depth w.r.t. the coordinate system in which they were observed for the first time. In this work we present a method to estimate the cross-covariances between landmarks which are introduced in the EKF state vector for the first time and the old filter state that can be applied in the special case at hand where each landmark is parameterized w.r.t. an individual coordinate system.