3 known landmarks are enough for solving planar bearing SLAM and fully reconstruct unknown inputs

In this paper we show that for an observer moving in the plane with no other information than the measurement of relative bearing to three known landmarks, it is possible to completely reconstruct its position and velocity. In particular this applies to the case where no model of the vehicle, nor odometry or acceleration measurements are available. Furthermore, in the same hypotheses, the position of any further landmark can be reconstructed from its bearing only. These results are more general than what is currently known on nonlinear observability of the SLAM problem, which relies on known observer velocities. Our results are also more general than the 2D version of known structure-from-motion observability results, which assume unknown but constant velocities. The proposed method is used to build a nonlinear observer directly applicable to a range of problems from computer vision to autonomous visual navigation

Observer design for position and velocity bias estimation from a single direction output

This paper addresses the problem of estimating the position of an object moving in $R^n$ from direction and velocity measurements. After addressing observability issues associated with this problem, a nonlinear observer is designed so as to encompass the case where the measured velocity is corrupted by a constant bias. Global exponential convergence of the estimation error is proved under a condition of persistent excitation upon the direction measurements. Simulation results illustrate the performance of the observer.Comment: 6 pages, 6 figure

RT-SLAM: A Generic and Real-Time Visual SLAM Implementation

This article presents a new open-source C++ implementation to solve the SLAM problem, which is focused on genericity, versatility and high execution speed. It is based on an original object oriented architecture, that allows the combination of numerous sensors and landmark types, and the integration of various approaches proposed in the literature. The system capacities are illustrated by the presentation of an inertial/vision SLAM approach, for which several improvements over existing methods have been introduced, and that copes with very high dynamic motions. Results with a hand-held camera are presented.Comment: 10 page

Autonomous navigation with constrained consistency for C-Ranger

Autonomous underwater vehicles (AUVs) have become the most widely used tools for undertaking complex exploration tasks in marine environments. Their synthetic ability to carry out localization autonomously and build an environmental map concurrently, in other words, simultaneous localization and mapping (SLAM), are considered to be pivotal requirements for AUVs to have truly autonomous navigation. However, the consistency problem of the SLAM system has been greatly ignored during the past decades. In this paper, a consistency constrained extended Kalman filter (EKF) SLAM algorithm, applying the idea of local consistency, is proposed and applied to the autonomous navigation of the C-Ranger AUV, which is developed as our experimental platform. The concept of local consistency (LC) is introduced after an explicit theoretical derivation of the EKF-SLAM system. Then, we present a locally consistency-constrained EKF-SLAM design, LC-EKF, in which the landmark estimates used for linearization are fixed at the beginning of each local time period, rather than evaluated at the latest landmark estimates. Finally, our proposed LC-EKF algorithm is experimentally verified, both in simulations and sea trials. The experimental results show that the LC-EKF performs well with regard to consistency, accuracy and computational efficiency

Cooperative monocular-based SLAM for multi-UAV systems in GPS-denied environments

This work presents a cooperative monocular-based SLAM approach for multi-UAV systems that can operate in GPS-denied environments. The main contribution of the work is to show that, using visual information obtained from monocular cameras mounted onboard aerial vehicles flying in formation, the observability properties of the whole system are improved. This fact is especially notorious when compared with other related visual SLAM configurations. In order to improve the observability properties, some measurements of the relative distance between the UAVs are included in the system. These relative distances are also obtained from visual information. The proposed approach is theoretically validated by means of a nonlinear observability analysis. Furthermore, an extensive set of computer simulations is presented in order to validate the proposed approach. The numerical simulation results show that the proposed system is able to provide a good position and orientation estimation of the aerial vehicles flying in formation.Peer ReviewedPostprint (published version

Avoiding negative depth in inverse depth bearing-only SLAM

In this paper we consider ways to alleviate negative estimated depth for the inverse depth parameterisation of bearing-only SLAM. This problem, which can arise even if the beacons are far from the platform, can cause catastrophic failure of the filter.We consider three strategies to overcome this difficulty: applying inequality constraints, the use of truncated second order filters, and a reparameterisation using the negative logarithm of depth. We show that both a simple inequality method and the use of truncated second order filters are succesful. However, the most robust peformance is achieved using the negative log parameterisation. ©2008 IEEE