Guaranteed Performance Nonlinear Observer for Simultaneous Localization and Mapping

TL;DR

This paper introduces a geometric nonlinear observer algorithm on Lie groups for SLAM that guarantees predefined transient and steady-state performance, accurately estimating pose and landmarks while compensating for measurement biases.

Contribution

It presents a novel SLAM observer on the Lie group SLAM(3) with guaranteed performance and bias compensation, advancing nonlinear SLAM estimation methods.

Findings

Effective pose and landmark estimation demonstrated through numerical simulations.

Observer achieves asymptotic convergence with predefined transient and steady-state bounds.

Compensates for unknown constant biases in velocity measurements.

Abstract

A geometric nonlinear observer algorithm for Simultaneous Localization and Mapping (SLAM) developed on the Lie group of \mathbb{SLAM}_{n}\left(3\right) is proposed. The presented novel solution estimates the vehicle's pose (i.e. attitude and position) with respect to landmarks simultaneously positioning the reference features in the global frame. The proposed estimator on manifold is characterized by predefined measures of transient and steady-state performance. Dynamically reducing boundaries guide the error function of the system to reduce asymptotically to the origin from its starting position within a large given set. The proposed observer has the ability to use the available velocity and feature measurements directly. Also, it compensates for unknown constant bias attached to velocity measurements. Unit-qauternion of the proposed observer is presented. Numerical results reveal effectiveness of the proposed observer. Keywords: Nonlinear filter algorithm, Nonlinear observer for Simultaneous Localization and Mapping, Nonlinear estimator, nonlinear SLAM observer on manifold, nonlinear SLAM filter on matrix Lie Group, observer design, asymptotic stability, systematic convergence, Prescribed performance function, pose estimation, attitude filter, position filter, feature filter, landmark filter, gradient based SLAM observer, gradient based observer for SLAM, adaptive estimate, SLAM observer, observer SLAM framework, equivariant observer, inertial vision unit, visual, SLAM filter, SE(3), SO(3).