Search papers, labs, and topics across Lattice.
This paper introduces a dual pose-graph SLAM architecture that fuses visual-inertial odometry with semantic gate detections to improve localization for autonomous drone racing. The system uses a temporary graph to refine multiple gate observations into a single constraint before adding it to a persistent main graph, preventing performance degradation from graph growth. Experiments on the TII-RATM dataset show a 56-74% reduction in Absolute Trajectory Error (ATE) compared to VIO, and real-world deployment in the A2RL competition demonstrated real-time onboard localization with reduced drift.
Autonomous drones can now navigate race courses with significantly improved accuracy thanks to a novel dual pose-graph SLAM architecture that fuses visual and semantic information.
Autonomous drone racing demands robust real-time localization under extreme conditions: high-speed flight, aggressive maneuvers, and payload-constrained platforms that often rely on a single camera for perception. Existing visual SLAM systems, while effective in general scenarios, struggle with motion blur and feature instability inherent to racing dynamics, and do not exploit the structured nature of racing environments. In this work, we present a dual pose-graph architecture that fuses odometry with semantic detections for robust localization. A temporary graph accumulates multiple gate observations between keyframes and optimizes them into a single refined constraint per landmark, which is then promoted to a persistent main graph. This design preserves the information richness of frequent detections while preventing graph growth from degrading real-time performance. The system is designed to be sensor-agnostic, although in this work we validate it using monocular visual-inertial odometry and visual gate detections. Experimental evaluation on the TII-RATM dataset shows a 56% to 74% reduction in ATE compared to standalone VIO, while an ablation study confirms that the dual-graph architecture achieves 10% to 12% higher accuracy than a single-graph baseline at identical computational cost. Deployment in the A2RL competition demonstrated that the system performs real-time onboard localization during flight, reducing the drift of the odometry baseline by up to 4.2 m per lap.
