A GTSAM-Based Monocular Visual-Inertial Odometry for Indoor UAVs: Robust Initialization and Single-Configuration Validation on EuRoC

Reliable localization without GPS is a prerequisite for autonomous unmanned aerial vehicles (UAVs) operating inside warehouses, where a lightweight monocular camera paired with an inertial measurement unit (IMU) and onboard computer are the minimal sensing and processing an onboard platform can carry. This paper presents a tightly coupled monocular point-feature visual-inertial odometry (VIO) system for that setting, realized on a GTSAM fixed-lag factor graph with inverse-depth landmarks, on-manifold IMU preintegration, and an online loop-closure pose graph. The system is developed as the initial estimation stage of an autonomous stock-management UAV under development for indoor logistics warehouses. The decisive design element is the bootstrap: the metric, gravity-aligned initialization of a monocular estimator is well conditioned only under a translation-rich trajectory, a condition the near-zero-baseline pickup and takeoff transient that opens every indoor flight violates. Building on the visual-inertial alignment of VINS-Mono, we harden this step with a pre-bundle-adjust conditioning gate and a continuous-window initialization that refines the whole bootstrap window inside the smoother instead of freezing a single seed. On all eleven EuRoC MAV sequences, indoor flight tests recorded onboard a micro air vehicle in an industrial hall and two instrumented rooms, one fixed configuration per operating environment converges on every sequence, including three that otherwise diverge by tens to thousands of meters, and, driven by the same feature stream as locally run VINS-Mono and PL-VINS baselines, attains the better pure-odometry accuracy on nine of the eleven, with ATE RMSE of 0.12–0.37 m on the Machine Hall, a margin a paired signed-rank test confirms against VINS-Mono and leaves unconfirmed against PL-VINS at this sample size. We identify the stock fixed-lag marginalization as the principal consistency limitation and outline First-Estimates-Jacobian marginalization as the route to a more consistent estimator, establishing a characterized point-only baseline on one public benchmark as the starting point for subsequent on-platform work.

Authors

Institutions

Publication Details

Journal
Drones
Published
2026-09-09
DOI
https://doi.org/10.3390/drones10090685
Primary Topic
Robotics and Sensor-Based Localization
Type
article
Field-Weighted Citation Impact
0.00
Controls
|||
ALL TIME
JAN
FEB
MAR
APR
MAY
JUN
JUL
AUG
SEP
OCT
article

A GTSAM-Based Monocular Visual-Inertial Odometry for Indoor UAVs: Robust Initialization and Single-Configuration Validation on EuRoC

André Dias, João J. Martins, José Almeida, Gabriel André Aráujo et al.
Drones
Robotics and Sensor-Based Localization
article

A GTSAM-Based Monocular Visual-Inertial Odometry for Indoor UAVs: Robust Initialization and Single-Configuration Validation on EuRoC

André Dias, João J. Martins, José Almeida, Gabriel André Aráujo, Ruben Santos
article en

Abstract

Reliable localization without GPS is a prerequisite for autonomous unmanned aerial vehicles (UAVs) operating inside warehouses, where a lightweight monocular camera paired with an inertial measurement unit (IMU) and onboard computer are the minimal sensing and processing an onboard platform can carry. This paper presents a tightly coupled monocular point-feature visual-inertial odometry (VIO) system for that setting, realized on a GTSAM fixed-lag factor graph with inverse-depth landmarks, on-manifold IMU preintegration, and an online loop-closure pose graph. The system is developed as the initial estimation stage of an autonomous stock-management UAV under development for indoor logistics warehouses. The decisive design element is the bootstrap: the metric, gravity-aligned initialization of a monocular estimator is well conditioned only under a translation-rich trajectory, a condition the near-zero-baseline pickup and takeoff transient that opens every indoor flight violates. Building on the visual-inertial alignment of VINS-Mono, we harden this step with a pre-bundle-adjust conditioning gate and a continuous-window initialization that refines the whole bootstrap window inside the smoother instead of freezing a single seed. On all eleven EuRoC MAV sequences, indoor flight tests recorded onboard a micro air vehicle in an industrial hall and two instrumented rooms, one fixed configuration per operating environment converges on every sequence, including three that otherwise diverge by tens to thousands of meters, and, driven by the same feature stream as locally run VINS-Mono and PL-VINS baselines, attains the better pure-odometry accuracy on nine of the eleven, with ATE RMSE of 0.12–0.37 m on the Machine Hall, a margin a paired signed-rank test confirms against VINS-Mono and leaves unconfirmed against PL-VINS at this sample size. We identify the stock fixed-lag marginalization as the principal consistency limitation and outline First-Estimates-Jacobian marginalization as the route to a more consistent estimator, establishing a characterized point-only baseline on one public benchmark as the starting point for subsequent on-platform work.

DronesVol. 10(9)
INESC TEC (PT), Polytechnic Institute of Porto (PT)
Reduced inequalities
Openalex Percentile: Top 7%
Robotics and Sensor-Based Localization
AI Navigator

Ask Laika to Summarize, Analyze, and Connect papers live on the map.

Summarize Papers & Methodologies

Extract key findings, datasets, and comparative methods across publications.

Benchmark Rankings & Visual Analytics

Rank top research institutions, authors, funders, topics, and journals by Field-Weighted Citation Impact (FWCI) and paper volume with instant charts.

Connect Distant Disciplines

Bridge topological clusters on the map to find hidden collaborative intersections.