osmAG-Nav: A Hierarchical Semantic Topometric Navigation Stack for Robust Lifelong Indoor Autonomy

arXiv cs.RO / 3/31/2026

📰 NewsDeveloper Stack & InfrastructureSignals & Early TrendsModels & Research

Key Points

  • osmAG-Nav is introduced as a complete, open-source ROS2 navigation stack designed for robust lifelong navigation in large, multi-floor indoor (and indoor-outdoor) environments.
  • The approach uses a hierarchical semantic topometric map based on OpenStreetMap Area Graph (osmAG) to decouple global topological planning from local metric execution, avoiding the scalability bottlenecks of monolithic occupancy-grid maps.
  • Planning performance is improved by replacing dense grid searches with an LCA-anchored, passage-centric graph pipeline whose edge costs come from local raster traversability rather than straight-line (Euclidean) distance, enabling low-millisecond planning on campus-scale routes.
  • Local computation and memory usage are stabilized via a Rolling Window local metric grid whose size is fixed around the robot, keeping the costmap footprint independent of the total mapped area.
  • Robustness is further enhanced with structure-aware LiDAR localization that filters dynamic clutter using permanent architectural priors, and experiments on a >11,025 m² multi-story campus report up to 7816× lower planning latency versus a grid baseline on long routes while maintaining localization stability; the modular ROS2 Lifecycle Nodes are released as a full stack.

Abstract

The deployment of mobile robots in large-scale, multi-floor environments demands navigation systems that achieve spatial scalability without compromising local kinematic precision. Traditional navigation stacks, reliant on monolithic occupancy grid maps, face severe bottlenecks in storage efficiency, cross-floor reasoning, and long-horizon planning. To address these limitations, this paper presents osmAG-Nav, a complete, open-source ROS2 navigation stack built upon the hierarchical semantic topometric OpenStreetMap Area Graph (osmAG) map standard. The system follows a "System of Systems" architecture that decouples global topological reasoning from local metric execution. A Hierarchical osmAG planner replaces dense grid searches with an LCA-anchored pipeline on a passage-centric graph whose edge costs derive from local raster traversability rather than Euclidean distance, yielding low-millisecond planning on long campus-scale routes. A Rolling Window mechanism rasterizes a fixed-size local metric grid around the robot, keeping the local costmap memory footprint independent of the total mapped area, while a Segmented Execution strategy dispatches intermediate goals to standard ROS2 controllers for smooth handoffs. System robustness is reinforced by a structure-aware LiDAR localization framework that filters dynamic clutter against permanent architectural priors. Extensive experiments on a real-world multi-story indoor-outdoor campus (>11,025 m^2) show that, on the same-floor benchmark subset, osmAG-Nav delivers up to 7816x lower planning latency than a grid-based baseline on long routes while maintaining low path-length overhead and lifelong localization stability. A single-floor long-range robot mission further validates the integrated stack reliability. The full stack is released as modular ROS2 Lifecycle Nodes.