Track papers across labs, topics, and trends.
Search papers, labs, and topics across Lattice.
This paper introduces TANGO-VIO, a novel triangulation-aware navigation framework that enhances visual-inertial odometry by ensuring feature-observability during navigation. By embedding a log-determinant metric of the stacked-bearing matrix into a control barrier function, the method guarantees a lower bound on triangulation-information metrics, effectively addressing challenges posed by pure rotation and low-parallax scenarios. Experimental results demonstrate that TANGO-VIO significantly improves triangulation conditioning and maintains consistent performance in both simulations and real-world flight tests.
Triangulation-aware navigation can now ensure feature observability even in challenging motion scenarios, transforming visual-inertial odometry reliability.
In vision-aided navigation and visual-inertial odometry, the quality of triangulated three-dimensional feature positions is a fundamental prerequisite for state estimation accuracy. Triangulation becomes ill-conditioned or even impossible when a camera undergoes pure rotation without translation, or when the observed bearing vectors provide insufficient parallax. Even though visual-inertial odometry has been extensively studied, the active maintenance of feature-observability during navigation has not been sufficiently addressed in the literature. To address this gap, this study presents TANGO-VIO, a triangulation-aware navigation framework that embeds a log-determinant metric of the feature-wise stacked-bearing matrix into a control barrier function. In this proposed method, the observability guarantee is established in the feature-geometric sense by enforcing a lower bound on the aggregate triangulation-information metric through a nominal-direction-weighted minimum-deviation velocity correction. The proposed architecture is evaluated through software-inthe- loop simulations and real flight experiments. The results show improved triangulation conditioning under low-parallax motion, while the flight response closely reproduces the corresponding simulation behavior and confirms the practical realizability of the proposed safety filter. Supplementary materials are available on the project webpage.