3d simultaneous localization and mapping using imu and its observability analysis

  • Authors:
  • Farhad Aghili

  • Affiliations:
  • Canadian space agency (csa), space exploration, 6767 route de l'aeroport, quebec j3y 8y9, canada

  • Venue:
  • Robotica
  • Year:
  • 2011

Quantified Score

Hi-index 0.00

Visualization

Abstract

This paper investigates 3-dimensional (3D) Simultaneous Localization and Mapping (SLAM) and the corresponding observability analysis by fusing data from landmark sensors and a strap-down Inertial Measurement Unit (IMU) in an adaptive Kalman filter (KF). In addition to the vehicle's states and landmark positions, the self-tuning filter estimates the IMU calibration parameters as well as the covariance of the measurement noise. The discrete-time covariance matrix of the process noise, the state transition matrix and the observation sensitivity matrix are derived in closed form, making it suitable for real-time implementation. Examination of the observability of the 3D SLAM system leads to the the conclusion that the system remains observable, provided that at least three known landmarks, which are not placed in a straight line, are observed.