This paper establishes the first general structural solution to the problem of state estimation for nonlinear systems driven by unknown inputs. Building upon nonlinear unknown-input observability theory, we show that every such system admits a structurally equivalent representation, referred to as the UID-induced normal form. The proposed representation decomposes the information carried by the unknown inputs into two complementary components: unknown-input directions that are structurally decoupled from the observable dynamics and observable quantities that completely represent the unknown-input information affecting the observable dynamics. As a consequence, the UID-induced normal form provides a unified structural solution to unknown-input decoupling and unknown-input reconstruction, without requiring any model or stochastic assumption on the unknown inputs. The practical significance of the proposed framework is demonstrated through a previously unexplored minimal Structure-from-Motion configuration. The proposed representation enables recursive state estimation from only three point features and a single-axis gyroscope, allowing the recovery of the three-dimensional structure and camera motion up to an unknown global scale factor. Experiments on real-world data validate the proposed framework and demonstrate the feasibility of this minimal sensing configuration.
Figures & tables
Figure 1: First image of the selected EuRoC V1_01_easy sequence (timestamp 1403715394962142976 ns) with the ten tracked point features used in the experiments. Depending on the considered sensing configuration, only a subset of these features is employed by the estimator.
Case
Point
Gyro
Linear
Remarks
Features
Axes
Velocity Axes
C0
2
2
0
Unobservable
C1
3
1
0
Minimal
C2
3
2
0
—
C3
3
3
0
—
C4
3
0
1
Minimal (metric scale)
Table 1: Experimental sensing configurations evaluated in this paper. Minimal configurations predicted by the observability analysis are highlighted in bold.
Case
Mean Relative
Mean Absolute
Inverse-Depth Error
Inverse-Depth Error
(–)
( m−1 )
C0
0.9215
0.8069
C1
0.0612
0.4502
C2
0.0363
0.4387
C3
0.0088
0.4978
Table 2: Final estimation errors of the inverse-depth variables. The relative error evaluates the reconstructed scene geometry independently of the global scale factor, while the absolute error evaluates metric reconstruction.
Figure 2: Experimental validation of the UID-induced normal form on the EuRoC MAV dataset. The plots report the mean relative inverse-depth error over the considered point features during the estimation interval. The first plot compares configurations C0–C4, including the unobservable configuration C0 and the minimal configurations involving three point features. The second plot reports configurations C5–C9, corresponding to additional observable sensing configurations with increased visual or inertial information. The results show that all configurations predicted as observable up to the global scale factor achieve convergence of the relative inverse-depth estimates, whereas the unobservable configuration C0 exhibits a persistent estimation error.
Accurately recovering the camera's calibration and metric poses for any unconstrained video would unlock large-scale training data for navigation and scene understanding. The dominant approaches to this problem are severely limited: Simultaneous Localization and Mapping (SLAM) is sensitive to initialization and transient failures due to its causal, incremental nature; it is often over-optimized for real-time operation and generally requires known camera calibration; while Structure-from-Motion (SfM) typically forgoes any image ordering, enabling optimal initialization and global optimization, but lacks robustness to visual symmetries and extreme motions. To bridge this gap, we introduce a system that combines the strong sequential constraints of SLAM with the flexibility and global optimization of offline SfM, enabling the metric reconstruction of arbitrary, long, uncalibrated videos. This system leverages recent advances in wide-baseline dense image matching, treats temporal ordering as a first-class citizen for reliable loop closure, and augments global optimization with metric monocular depth priors. As a result, thorough evaluations on diverse, challenging datasets that exhibit extreme motion and visual symmetries reveal that our approach is significantly more robust and accurate than both state-of-the-art SLAM and SfM, classical or learned, with given or unknown camera calibration. The code is publicly available at https://github.com/cvg/vidmap.
Visual navigation in unknown environments remains a core challenge in mobile robotics, especially for resource-constrained platforms. Most existing approaches rely on loosely coupled modular pipelines and strong assumptions on perception quality or environmental structure, often resorting to multi-modal sensor suites that increase system complexity and deployment cost. Vision-only navigation offers a lightweight alternative, but its performance degrades severely under motion blur, low texture, and illumination changes, largely because they neglect the tight coupling between commanded motion and perception. While perception-aware methods partially address this issue, they typically optimize individual modules and fail to propagate uncertainty consistently across the navigation stack. In this paper, we present UNSEEN, a unified uncertainty- and perception-aware navigation framework that explicitly couples localization, mapping, and planning using only a front-mounted camera. UNSEEN estimates sparse maps and robot poses with associated uncertainties at 6Hz, and leverages them to plan trajectories that jointly optimize task progress and estimation accuracy in receding-horizon. Simulations and extensive real-world experiments in unknown environments demonstrate the robustness of the proposed approach, with UNSEEN-SLAM reducing absolute translational error by 9.8% and UNSEEN-Plan improving estimation accuracy by up to 45% compared to state-of-the-art methods, while achieving a 100% task success rate.
Tommaso Faraci, Marco Camurri, Daniele Fontanelli +1
Solving non-linear least-squares problem for pose estimation (rotation and translation) is often a time consuming yet fundamental problem in several real-time computer vision applications. With an adequate rotation parametrization, the optimization problem can be reduced to the solution of a~system of polynomial equations and solved in closed form. Recent advances in efficient closed form solvers utilizing resultant matrices have shown a promising research direction to decrease the computation time while preserving the estimation accuracy. In this paper, we propose a new class of resultant-based solvers that exploit Sylvester forms to further reduce the complexity of the resolution. We demonstrate that our proposed methods are numerically as accurate as the state-of-the-art solvers, and outperform them in terms of computational time. We show that this approach can be applied for pose estimation in two different types of problems: estimating a pose from 3D to 3D correspondences, and estimating a pose from 3D points to 2D points correspondences.
Jana Vráblíková, Ezio Malis, Laurent Busé
AROMATH · Centre Inria d’Universit´e Cˆote d’Azur, France · ACENTAURI