604 research outputs found

    Initialization of 3D Pose Graph Optimization using Lagrangian duality

    Get PDF
    Pose Graph Optimization (PGO) is the de facto choice to solve the trajectory of an agent in Simultaneous Localization and Mapping (SLAM). The Maximum Likelihood Estimation (MLE) for PGO is a non-convex problem for which no known technique is able to guarantee a globally optimal solution under general conditions. In recent years, Lagrangian duality has proved suitable to provide good, frequently tight relaxations of the hard PGO problem through convex Semidefinite Programming (SDP). In this work, we build from the state-of-the-art Lagrangian relaxation [1] and contribute a complete recovery procedure that, given the (tractable) optimal solution of the relaxation, provides either the optimal MLE solution if the relaxation is tight, or a remarkably good feasible guess if the relaxation is non-tight, which occurs in specially challenging PGO problems (very noisy observations, low graph connectivity, etc.). In the latter case, when used for initialization of local iterative methods, our approach outperforms other state-ofthe- art approaches converging to better solutions. We support our claims with extensive experiments.University of Malaga travel grant, the Spanish grant program FPU14/06098 and the project PROMOVE (DPI2014-55826-R), funded by the Spanish Government and the "European Regional Development Fund". Universidad de Málaga. Campus de Excelencia Internacional Andalucía Tech

    Geometric-based Line Segment Tracking for HDR Stereo Sequences

    Get PDF
    In this work, we propose a purely geometrical approach for the robust matching of line segments for challenging stereo streams with severe illumination changes or High Dynamic Range (HDR) environments. To that purpose, we exploit the univocal nature of the matching problem, i.e. every observation must be corresponded with a single feature or not corresponded at all. We state the problem as a sparse, convex, `1-minimization of the matching vector regularized by the geometric constraints. This formulation allows for the robust tracking of line segments along sequences where traditional appearance-based matching techniques tend to fail due to dynamic changes in illumination conditions. Moreover, the proposed matching algorithm also results in a considerable speed-up of previous state of the art techniques making it suitable for real-time applications such as Visual Odometry (VO). This, of course, comes at expense of a slightly lower number of matches in comparison with appearance based methods, and also limits its application to continuous video sequences, as it is rather constrained to small pose increments between consecutive frames.We validate the claimed advantages by first evaluating the matching performance in challenging video sequences, and then testing the method in a benchmarked point and line based VO algorithm.Universidad de Málaga. Campus de Excelencia Internacional Andalucía Tech.This work has been supported by the Spanish Government (project DPI2017-84827-R and grant BES-2015-071606) and by the Andalucian Government (project TEP2012-530)

    An evaluation of plume tracking as a strategy for gas source localization in turbulent wind flows

    Get PDF
    Gas source localization is likely the most direct application of a mobile robot endowed with gas sensing capabilities. Multiple algorithms have been proposed to locate the gas source within a known environment, ranging from bio-inspired to probabilistic ones. However, their application to real-world conditions still remains a major issue due to the great difficulties those scenarios bring, among others, the common presence of obstacles which hamper the movement of the robot and notably ncrease the complexity of the gas dispersion. In this work, we consider a plume tracking algorithm based on the well-known silkworm moth strategy and analyze its performance when facing different realistic environments characterized by the presence of obstacles and turbulent wind flows. We rely on computational fluid dynamics and the open source gas dispersion simulator GADEN to generate realistic gas distributions in scenarios where the presence of obstacles breaks down the ideal downwind plume. We first propose some modifications to the original silkworm moth algorithm in order to deal with the presence of obstacles in the environment (avoiding collisions) and then analyze its performance within four challenging environments.Universidad de Málaga. Campus de Excelencia Internacional Andalucía Tech. Proyecto de excelencia de la Junata de Andalucia TEP2012-53

    A Primal-Dual Framework for Real-Time Dense RGB-D Scene Flow

    Get PDF
    This paper presents the first method to compute dense scene flow in real-time for RGB-D cameras. It is based on a variational formulation where brightness constancy and geometric consistency are imposed. Accounting for the depth data provided by RGB-D cameras, regularization of the flow field is imposed on the 3D surface (or set of surfaces) of the observed scene instead of on the image plane, leading to more geometrically consistent results. The minimization problem is efficiently solved by a primal-dual algorithm which is implemented on a GPU, achieving a previously unseen temporal performance. Several tests have been conducted to compare our approach with a state-of-the-art work (RGB-D flow) where quantitative and qualitative results are evaluated. Moreover, an additional set of experiments have been carried out to show the applicability of our work to estimate motion in realtime. Results demonstrate the accuracy of our approach, which outperforms the RGB-D flow, and which is able to estimate heterogeneous and non-rigid motions at a high frame rate.Universidad de Málaga. Campus de Excelencia Internacional Andalucía Tech. Research supported by the Spanish Government under project DPI1011-25483 and the Spanish grant program FPI-MICINN 2012
    • …