Skip to Main content Skip to Navigation
Journal articles

Cooperative Visual-Inertial Sensor Fusion: the Analytic Solution

Agostino Martinelli 1 Alexander Oliva 1 Bernard Mourrain 2
1 CHROMA - Robots coopératifs et adaptés à la présence humaine en environnements dynamiques
Inria Grenoble - Rhône-Alpes, CITI - CITI Centre of Innovation in Telecommunications and Integration of services
2 AROMATH - AlgebRe, geOmetrie, Modelisation et AlgoriTHmes
CRISAM - Inria Sophia Antipolis - Méditerranée , NKUA | UoA - National and Kapodistrian University of Athens = University of Athens
Abstract : This letter analyzes the visual–inertial sensor fusion problem in the cooperative case of two agents, and proves that this sensor fusion problem is equivalent to a simple polynomial equations system that consists of several linear equations and three polynomial equations of second degree. The analytic solution of this polynomial equations system is easily obtained by using an algebraic method. In other words, this letter provides the analytic solution to the visual–inertial sensor fusion problem in the case of two agents. The power of the analytic solution is twofold. From one side, it allows us to determine the relative state between the agents (i.e., relative position, speed, and orientation) without the need of an initialization. From another side, it provides fundamental insights into all the theoretical aspects of the problem. This letter mainly focuses on the first issue. However, the analytic solution is also exploited to obtain basic structural properties of the problem that characterize the observability of the absolute scale and the relative orientation. Extensive simulations and real experiments show that the solution is successful in terms of precision and robustness.
Complete list of metadatas

Cited literature [26 references]  Display  Hide  Download
Contributor : Agostino Martinelli <>
Submitted on : Tuesday, August 6, 2019 - 2:07:45 PM
Last modification on : Tuesday, January 14, 2020 - 1:36:09 PM
Document(s) archivé(s) le : Thursday, January 9, 2020 - 3:11:51 AM


mainHAL (1).pdf
Files produced by the author(s)



Agostino Martinelli, Alexander Oliva, Bernard Mourrain. Cooperative Visual-Inertial Sensor Fusion: the Analytic Solution. IEEE Robotics and Automation Letters, IEEE 2019, 4 (2), pp.453-460. ⟨10.1109/LRA.2019.2891025⟩. ⟨hal-01966542⟩



Record views


Files downloads