Person:
Dellaert, Frank

Permanent Link
https://hdl.handle.net/1853/71202
Associated Organization(s)
Organizational Unit
ORCID
ArchiveSpace Name Record

Filters

2013 - 2015 13
13
11 1 1
13
13
Reset filters

Settings
Author: Carlone, Luca × End date: 2019 × Start date: 2010 ×

Publication Search Results

Now showing 1 - 10 of 13
Thumbnail Image
Item

Supplementary Material to: IMU Preintegration on Manifold for Efficient Visual-Inertial Maximum-a-Posteriori Estimation

2015-05-30 , Forster, Christian , Carlone, Luca , Dellaert, Frank , Scaramuzza, Davide

View
Thumbnail Image
Item

IMU Preintegration on Manifold for Efficient Visual-Inertial Maximum-a-Posteriori Estimation

2015 , Forster, Christian , Carlone, Luca , Dellaert, Frank , Scaramuzza, Davide

Recent results in monocular visual-inertial navigation (VIN) have shown that optimization-based approaches outperform filtering methods in terms of accuracy due to their capability to relinearize past states. However, the improvement comes at the cost of increased computational complexity. In this paper, we address this issue by preintegrating inertial measurements between selected keyframes. The preintegration allows us to accurately summarize hundreds of inertial measurements into a single relative motion constraint. Our first contribution is a preintegration theory that properly addresses the manifold structure of the rotation group and carefully deals with uncertainty propagation. The measurements are integrated in a local frame, which eliminates the need to repeat the integration when the linearization point changes while leaving the opportunity for belated bias corrections. The second contribution is to show that the preintegrated IMU model can be seamlessly integrated in a visual-inertial pipeline under the unifying framework of factor graphs. This enables the use of a structureless model for visual measurements, further accelerating the computation. The third contribution is an extensive evaluation of our monocular VIN pipeline: experimental results confirm that our system is very fast and demonstrates superior accuracy with respect to competitive state-of-the-art filtering and optimization algorithms, including off-the-shelf systems such as Google Tango [1].

View
Thumbnail Image
Item

Planning in the Continuous Domain: a Generalized Belief Space Approach for Autonomous Navigation in Unknown Environments

2015 , Indelman, Vadim , Carlone, Luca , Dellaert, Frank

We investigate the problem of planning under uncertainty, with application to mobile robotics. We propose a probabilistic framework in which the robot bases its decisions on the generalized belief, which is a probabilistic description of its own state and of external variables of interest. The approach naturally leads to a dual-layer architecture: an inner estimation layer, which performs inference to predict the outcome of possible decisions, and an outer decisional layer which is in charge of deciding the best action to undertake. Decision making is entrusted to a Model Predictive Control (MPC) scheme. The formulation is valid for general cost functions and does not discretize the state or control space, enabling planning in continuous domain. Moreover, it allows to relax the assumption of maximum likelihood observations: predicted measurements are treated as random variables, and binary random variables are used to model the event that a measurement is actually taken by the robot. We successfully apply our approach to the problem of uncertainty-constrained exploration, in which the robot has to perform tasks in an unknown environment, while maintaining localization uncertainty within given bounds. We present an extensive numerical analysis of the proposed approach and compare it against related work. In practice, our planning approach produces smooth and natural trajectories and is able to impose soft upper bounds on the uncertainty. Finally, we exploit the results of this analysis to identify current limitations and show that the proposed framework can accommodate several desirable extensions.

View
Thumbnail Image
Item

Planning Under Uncertainty in the Continuous Domain: A Generalized Belief Space Approach

2014 , Indelman, Vadim , Carlone, Luca , Dellaert, Frank

This work investigates the problem of planning under uncertainty, with application to mobile robotics. We propose a probabilistic framework in which the robot bases its decisions on the generalized belief , which is a probabilistic description of its own state and of external variables of interest. The approach naturally leads to a dual-layer architecture: an inner estimation layer, which performs inference to predict the outcome of possible decisions, and an outer decisional layer which is in charge of deciding the best action to undertake. The approach does not discretize the state or control space, and allows planning in continuous domain. Moreover, it allows to relax the assumption of maximum likelihood observations: predicted measurements are treated as random variables and are not considered as given. Experimental results show that our planning approach produces smooth trajectories while maintaining uncertainty within reasonable bounds.

View
Thumbnail Image
Item

Duality-based Verification Techniques for 2D SLAM

2015-05 , Carlone, Luca , Dellaert, Frank

While iterative optimization techniques for Simultaneous Localization and Mapping (SLAM) are now very efficient and widely used, none of them can guarantee global convergence to the maximum likelihood estimate. Local convergence usually implies artifacts in map reconstruction and large localization errors, hence it is very undesirable for applications in which accuracy and safety are of paramount importance. We provide a technique to verify if a given 2D SLAM solution is globally optimal. The insight is that, while computing the optimal solution is hard in general, duality theory provides tools to compute tight bounds on the optimal cost, via convex programming. These bounds can be used to evaluate the quality of a SLAM solution, hence providing a “sanity check” for state-of-the-art incremental and batch solvers. Experimental results show that our technique successfully identifies wrong estimates (i.e., local minima) in large-scale SLAM scenarios. This work, together with [1], represents a step towards the objective of having SLAM techniques with guaranteed performance, that can be used in safety-critical applications.

View
Thumbnail Image
Item

Rigid Components Identification and Rigidity Enforcement in Bearing-Only Localization using the Graph Cycle Basis

2015 , Tron, Roberto , Carlone, Luca , Dellaert, Frank , Daniilidis, Kostas

Bearing-only localization can be formulated in terms of optimal graph embedding: one has to assign a 2-D or 3-D position to each node in a graph while satisfying as close as possible all the bearing-only constraints on the edges. If the graph is parallel rigid, this can be done via spectral methods. When the graph is not rigid the reconstruction is ambiguous, as different subsets of vertices can be scaled differently. It is therefore important to first identify a partition of the problem into maximal rigid components. In this paper we show that the cycle basis matrix of the graph not only translates into an algorithm to identify all rigid sub-graphs, but also provides a more intuitive way to look at graph rigidity, showing, for instance, why triangulated graphs are rigid and why graphs with long cycles may loose this property. Furthermore, it provides practical tools to enforce rigidity by adding a minimal number of measurements.

View
Thumbnail Image
Item

Selecting Good Measurements via ℓ₁ Relaxation: A Convex Approach for Robust Estimation Over Graphs

2014-09 , Carlone, Luca , Censi, Andrea , Dellaert, Frank

Pose graph optimization is an elegant and efficient formulation for robot localization and mapping. Experimental evidence suggests that, in real problems, the set of measurements used to estimate robot poses is prone to contain outliers, due to perceptual aliasing and incorrect data association. While several related works deal with the rejection of outliers during pose estimation, the goal of this paper is to propose a grounded strategy for measurements selection, i.e., the output of our approach is a set of “reliable” measurements, rather than pose estimates. Because the classification in inliers /outliers is not observable in general, we pose the problem as finding the maximal subset of the measurements that is internally coherent. In the linear case, we show that the selection of the maximal coherent set can be (conservatively) relaxed to obtain a linear programming problem with ℓ₁ objective. We show that this approach can be extended to (nonlinear) planar pose graph optimization using similar ideas as our previous work on linear approaches to pose graph optimization. We evaluate our method on standard datasets, and we show that it is robust to a large number of outliers and different outlier generation models, while entailing the advantages of linear programming (fast computation, scalability).

View
Thumbnail Image
Item

Initialization Techniques for 3D SLAM: A Survey on Rotation Estimation and its Use in Pose Graph Optimization

2015-05 , Carlone, Luca , Tron, Roberto , Daniilidis, Kostas , Dellaert, Frank

Pose graph optimization is the non-convex optimization problem underlying pose-based Simultaneous Localization and Mapping (SLAM). If robot orientations were known, pose graph optimization would be a linear least-squares problem, whose solution can be computed efficiently and reliably. Since rotations are the actual reason why SLAM is a difficult problem, in this work we survey techniques for 3D rotation estimation. Rotation estimation has a rich history in three scientific communities: robotics, computer vision, and control theory. We review relevant contributions across these communities, assess their practical use in the SLAM domain, and benchmark their performance on representative SLAM problems (Fig. 1). We show that the use of rotation estimation to bootstrap iterative pose graph solvers entails significant boost in convergence speed and robustness.

View
Thumbnail Image
Item

Lagrangian Duality in 3D SLAM: Verification Techniques and Optimal Solutions

2015 , Carlone, Luca , Rosen, David W. , Calafiore, Giuseppe , Leonard, John J. , Dellaert, Frank

State-of-the-art techniques for simultaneous localization and mapping (SLAM) employ iterative nonlinear optimization methods to compute an estimate for robot poses. While these techniques often work well in practice, they do not provide guarantees on the quality of the estimate. This paper shows that Lagrangian duality is a powerful tool to assess the quality of a given candidate solution. Our contribution is threefold. First, we discuss a revised formulation of the SLAM inference problem. We show that this formulation is probabilistically grounded and has the advantage of leading to an optimization problem with quadratic objective. The second contribution is the derivation of the corresponding Lagrangian dual problem. The SLAM dual problem is a (convex) semidefinite program, which can be solved reliably and globally by off-the-shelf solvers. The third contribution is to discuss the relation between the original SLAM problem and its dual. We show that from the dual problem, one can evaluate the quality (i.e., the suboptimality gap) of a candidate SLAM solution, and ultimately provide a certificate of optimality. Moreover, when the duality gap is zero, one can compute a guaranteed optimal SLAM solution from the dual problem, circumventing non-convex optimization. We present extensive (real and simulated) experiments supporting our claims and discuss practical relevance and open problems.

View
Thumbnail Image
Item

Mining Structure Fragments for Smart Bundle Adjustment

2014-09 , Carlone, Luca , Alcantarilla, Pablo Fernandez , Chiu, Han-Pang , Kira, Zsolt , Dellaert, Frank

Bundle Adjustment (BA) can be seen as an inference process over a factor graph. From this perspective, the Schur complement trick can be interpreted as an ordering choice for elimination. The elimination of a single point in the BA graph induces a factor over the set of cameras observing that point. This factor has a very low information content (a point observation enforces a low-rank constraint on the cameras). In this work we show that, when using conjugate gradient solvers, there is a computational advantage in “grouping” factors corresponding to sets of points (fragments) that are co-visible by the same set of cameras. Intuitively, we collapse many factors with low information content into a single factor that imposes a high-rank constraint among the cameras. We provide a grounded way to group factors: the selection of points that are co-observed by the same camera patterns is a data mining problem, and standard tools for frequent pattern mining can be applied to reveal the structure of BA graphs. We demonstrate the computational advantage of grouping in large BA problems and we show that it enables a consistent reduction of BA time with respect to state-of-the-art solvers (Ceres [1]).

View