Jose-Luis Blanco

Toward a Unified Bayesian Approach to Hybrid Metric--Topological SLAM

This paper introduces a new approach to simultaneous localization and mapping (SLAM) that pursues robustness and accuracy in large-scale environments. Like most successful works on SLAM, we use Bayesian filtering to provide a probabilistic estimation that can cope with uncertainty in the measurements, the robot pose, and the map. Our approach is based on the reconstruction of the robot path in a hybrid discrete-continuous state space, which naturally combines metric and topological maps. There are two fundamental characteristics that set this paper apart from previous ones: 1) the use of a unified Bayesian inference approach both for the metrical and the topological parts of the problem and 2) the analytical formulation of belief distributions over hybrid maps, which allows us to maintain the spatial uncertainty in large spaces more accurately and efficiently than in previous works. We also describe a practical implementation that aims for real-time operation. Our ideas have been validated by promising experimental results in large environments (up to 30 000 m2, a 2 km robot path) with multiple nested loops, which could hardly be managed appropriately by other approaches.

A collection of outdoor robotic datasets with centimeter-accuracy ground truth

The lack of publicly accessible datasets with a reliable ground truth has prevented in the past a fair and coherent comparison of different methods proposed in the mobile robot Simultaneous Localization and Mapping (SLAM) literature. Providing such a ground truth becomes specially challenging in the case of visual SLAM, where the world model is 3-dimensional and the robot path is 6-dimensional. This work addresses both the practical and theoretical issues found while building a collection of six outdoor datasets. It is discussed how to estimate the 6-d vehicle path from readings of a set of three Real Time Kinematics (RTK) GPS receivers, as well as the associated uncertainty bounds that can be employed to evaluate the performance of SLAM methods. The vehicle was also equipped with several laser scanners, from which reference point clouds are built as a testbed for other algorithms such as segmentation or surface fitting. All the datasets, calibration information and associated software tools are available for download http://babel.isa.uma.es/mrpt/papers/dataset2009/.

Mobile robot localization based on Ultra-Wide-Band ranging: A particle filter approach

This article addresses the problem of mobile robot localization using Ultra-Wide-Band (UWB) range measurements. UWB is a radio technology widely used for communications, that is recently receiving increasing attention for positioning applications. In these cases, the position of a mobile transceiver is determined from the distances to a set of fixed, well-localized beacons. Though this is a well-known problem in the scientific literature (the trilateration problem), the peculiarities of UWB range measurements (basically, distance errors and multipath effects) demand a different treatment to other similar solutions, as for example, those based on laser. This work presents a thorough experimental characterization of UWB ranges within a variety of environments and situations. From these experiments, we derive a probabilistic model which is then used by a particle filter to combine different readings from UWB beacons as well as the vehicle odometry. To account for the possible offset error due to multipath effects, the state tracked by the particle filter includes the offset of each beacon in addition to the planar robot pose (x,y,@f), both estimated sequentially. We show navigation results for a robot moving in indoor scenarios covered by three UWB beacons that validate our proposal.

Experimental kinematics for wheeled skid-steer mobile robots

This work aims at improving real-time motion control and dead-reckoning of wheeled skid-steer vehicles by considering the effects of slippage, but without introducing the complexity of dynamics computations in the loop. This traction scheme is found both in many off-the-shelf mobile robots due to its mechanical simplicity and in outdoor applications due to its maneuverability. In previous works, we reported a method to experimentally obtain an optimized kinematic model for skid-steer tracked vehicles based on the boundedness of the instantaneous centers of rotation (ICRs) of treads on the motion plane. This paper provides further insight on this method, which is now proposed for wheeled skid-steer vehicles. It has been successfully applied to a popular research robotic platform, pioneer P3-AT, with different kinds of tires and terrain types.

A statistical approach to gas distribution modelling with mobile robots - The Kernel DM+V algorithm

Gas distribution modelling constitutes an ideal application area for mobile robots, which - as intelligent mobile gas sensors - offer several advantages compared to stationary sensor networks. In this paper we propose the Kernel DM+V algorithm to learn a statistical 2-d gas distribution model from a sequence of localized gas sensor measurements. The algorithm does not make strong assumptions about the sensing locations and can thus be applied on a mobile robot that is not primarily used for gas distribution monitoring, and also in the case of stationary measurements. Kernel DM+V treats distribution modelling as a density estimation problem. In contrast to most previous approaches, it models the variance in addition to the distribution mean. Estimating the predictive variance entails a significant improvement for gas distribution modelling since it allows to evaluate the model quality in terms of the data likelihood. This offers a solution to the problem of ground truth evaluation, which has always been a critical issue for gas distribution modelling. Estimating the predictive variance also provides the means to learn meta parameters and to suggest new measurement locations based on the current model. We derive the Kernel DM+V algorithm and present a method for learning the hyper-parameters. Based on real world data collected with a mobile robot we demonstrate the consistency of the obtained maps and present a quantitative comparison, in terms of the data likelihood of unseen samples, with an alternative approach that estimates the predictive variance.

The Multi-Chamber Electronic Nose--an improved olfaction sensor for mobile robotics.

One of the major disadvantages of the use of Metal Oxide Semiconductor (MOS) technology as a transducer for electronic gas sensing devices (e-noses) is the long recovery period needed after each gas exposure. This severely restricts its usage in applications where the gas concentrations may change rapidly, as in mobile robotic olfaction, where allowing for sensor recovery forces the robot to move at a very low speed, almost incompatible with any practical robot operation. This paper describes the design of a new e-nose which overcomes, to a great extent, such a limitation. The proposed e-nose, called Multi-Chamber Electronic Nose (MCE-nose), comprises several identical sets of MOS sensors accommodated in separate chambers (four in our current prototype), which alternate between sensing and recovery states, providing, as a whole, a device capable of sensing changes in chemical concentrations faster. The utility and performance of the MCE-nose in mobile robotic olfaction is shown through several experiments involving rapid sensing of gas concentration and mobile robot gas mapping.

A Novel Measure of Uncertainty for Mobile Robot SLAM with Rao-Blackwellized Particle Filters

Rao—Blackwellized particle filters (RBPFs) are an implementation of sequential Bayesian filtering that has been successfully applied to mobile robot simultaneous localization and mapping (SLAM) and exploration. Measuring the uncertainty of the distribution estimated by a RBPF is required for tasks such as information gain-guided exploration or detecting loop closures in nested loop environments. In this paper we propose a new measure that takes the uncertainty in both the robot path and the map into account. Our approach relies on the entropy of the expected map (EM) of the RBPF, a new variable built by integrating the map hypotheses from all of the particles. Unlike previous works that use the joint entropy of the RBPF for active exploration, our proposal is better suited to detect opportunities to close loops, a key aspect to reduce the robot path uncertainty and consequently to improve the quality of the maps being built. We provide a theoretical discussion and experimental results with real data that support our claims.

Efficient probabilistic Range-Only SLAM

This work addresses range-only SLAM (RO-SLAM) as the Bayesian inference problem of sequentially tracking a vehicle while estimating the location of a set of beacons without any prior information. The only assumptions are the availability of odometry and a range sensor able of identifying the different beacons. We propose exploiting the conditional independence between the position distributions of each beacon within a Rao-Blackwellized Particle Filter (RBPF) for maintaining independent Sum of Gaussians (SOGs) for each beacon. Unlike other approaches, it is shown then that a proper probabilistic observation model can be derived for online operation with no need for delayed initializations. We provide a rigorous statistical comparison of this proposal with previous work of the authors where a Monte-Carlo approximation was employed instead for the conditional densities. As verified experimentally, this new proposal represents a significant improvement in accuracy, computation time, and robustness against outliers.

Application of UWB and GPS technologies for vehicle localization in combined indoor-outdoor environments

Ultra-wide band (UWB) sensors are innovative devices constructed for efficient wireless communications that have recently being used for vehicle localization in indoor environments. In contrast, GPS sensors are well-known satellite-based positioning devices widely extended for outdoor applications. We evaluate in this paper the combination of both technologies for efficient positioning of vehicles in a mixed scenario (both indoor and outdoor situations), which is typical in applications such as automatic guided vehicles transporting and storing goods among warehouses. The framework we propose for combining sensor information is Monte Carlo localization (also known as particle filters), which is a versatile solution to the fusion of different sensory data and exhibits a number of advantages with respect to other localization techniques. In the paper we describe our approach and evaluate it with several simulated experiments that have yielded promising results. This work, supported by the European project CRAFT-COOP-CT-2005-017668, becomes a first step toward a robust and reliable localization system for automated industrial vehicles.

A New Approach for Large-Scale Localization and Mapping: Hybrid Metric-Topological SLAM

Most successful works in simultaneous localization and mapping (SLAM) aim to build a metric map under a probabilistic viewpoint employing Bayesian filtering techniques. This work introduces a new hybrid metric-topological approach, where the aim is to reconstruct the path of the robot in a hybrid continuous-discrete state space which naturally combines metric and topological maps. Our fundamental contributions are: (i) the estimation of the topological path, an improvement similar to that of Rao-Blackwellized particle filters (RBPF) and FastSLAM in the field of metric map building; and (ii) the application of grounded methods to the abstraction of topology (including loop closure) from raw sensor readings. It is remarkable that our approach could be still represented as a Bayesian inference problem, becoming an extension of purely metric SLAM. Besides providing the formal definitions and the basics for our approach, we also describe a practical implementation aimed to real-time operation. Promising experimental results mapping large environments with multiple nested loops (~30.000 m2, ~2Km robot path) validate our work.