On the consistency analysis of A-SLAM for UAV navigation

摘要

Simultaneous Localization and Mapping (SLAM) is a good choice for UAV navigation when both UAV's position and region map are not known. Due to nonlinearity of kinematic equations of a UAV, Extended Kalman Filter (EKF) and Unscented Kalman Filter (UKF) are employed. In this study, EKF and UKF based A-SLAM concepts are discussed in details by presenting the formulations and simulation results. The UAV kinematic model and the state-observation models for EKF and UKF based A-SLAM methods are developed to analyze the filters' consistencies. Analysis during landmark observation exhibits an inconsistency in the form of a jagged UAV trajectory. It has been found that unobservable subspaces and the Jacobien matrices used for linearization are two major sources of the inconsistencies observed. UKF performs better in terms of filter consistency since it does not require the Jacobien matrix linearization.