Robust Lifelong Indoor LiDAR Localization using the Area Graph

Fujing Xie, Sören Schwertfeger

Abstract

Lifelong indoor localization is a fundamental requirement for autonomous mobile robots. Traditional map representations, such as occupancy grids or point clouds, are often "brittle" because they capture transient environmental features like furniture, which change over time. This paper introduces AGLoc, a robust localization system that utilizes the Area Graph—a hierarchical, topometric semantic map representation. By matching 3D LiDAR point clouds against permanent architectural features (walls and doors) defined by polygons, AGLoc achieves stable, lifelong localization in cluttered environments. Our experiments demonstrate that AGLoc provides high-accuracy global localization and efficient pose tracking, outperforming standard methods in dynamic indoor spaces.

Introduction

Most autonomous robots rely on 2D occupancy grids or 3D point clouds for navigation. While precise, these maps require frequent updates as the environment changes—for instance, when furniture is moved or partitions are rearranged. To achieve true lifelong autonomy, robots need maps that are compact, stable, and easy to acquire from existing architectural data.

AGLoc addresses this by shifting the focus from transient clutter to the building's permanent "skeleton." By using an Area Graph, the system represents rooms, corridors, and buildings as a series of polygons. This representation is not only orders of magnitude smaller than traditional grids but also remains valid for years without requiring updates.

The Area Graph representation uses polygons to demark semantic areas like rooms and corridors, providing a compact and stable map for localization.

The AGLoc Methodology

The AGLoc system processes 3D LiDAR data through a specialized pipeline designed to filter out noise and focus on architectural features. The process begins with a broad initial guess from WiFi and barometric data to determine the correct floor and general vicinity.

The AGLoc system architecture: from input 3D point clouds and WiFi initialization to final pose estimation via weighted ICP and corridorness scoring.

Key Technical Innovations

  1. Clutter Removal Subsampling: To handle cluttered environments, the system projects 3D points into 2D and retains only the furthest points in each angular column. This heuristic assumes that the furthest returns are most likely to be permanent walls rather than foreground clutter like chairs or people.
  2. Global Localization via Sampling: AGLoc solves the "kidnapped robot" problem by sampling thousands of potential poses within a WiFi-defined radius and scoring them against the Area Graph polygons using a custom error function.
  3. Corridorness Downsampling: In long, featureless corridors, standard ICP (Iterative Closest Point) algorithms often "slide" due to a lack of longitudinal features. AGLoc calculates a "corridorness" score based on wall orientation histograms and downsamples points on dominant parallel walls to emphasize rare features like door indentations.
  4. Weighted Point-to-Line ICP: For active tracking, the system uses a specialized weight function that ignores points likely to be clutter (inside rooms) or reflections (from glass), ensuring the robot stays locked onto the structural map.

Experimental Results

The authors evaluated AGLoc using datasets captured in heavily cluttered laboratories and office corridors. The system achieved a 98-99% success rate in global localization, finding the robot's position within 1.0 meter starting from a broad 6-meter search radius.

In terms of efficiency, pose tracking is remarkably fast, requiring only 12.5ms per frame on modest hardware. Head-to-head comparisons showed that AGLoc significantly outperformed standard AMCL (Adaptive Monte Carlo Localization) in corridor environments, particularly when maps were sparse.

Conclusion and Future Work

AGLoc demonstrates that architectural features are a superior foundation for lifelong robot localization compared to traditional occupancy grids. By leveraging the Area Graph, robots can navigate dynamic environments without the overhead of constant map maintenance. Future work will focus on optimizing global localization speed, integrating topological connectivity data for enhanced robustness, and developing more sophisticated semantic state estimation for dynamic elements like doors.

Summary updated

Abstract

Lifelong indoor localization in a given map is the basis for navigation of autonomous mobile robots. In this letter, we address the problem of robust localization in cluttered indoor environments like office spaces and corridors using 3D LiDAR point clouds in a given Area Graph, which is a hierarchical, topometric semantic map representation that uses polygons to demark areas such as rooms, corridors or buildings. This representation is very compact, can represent different floors of buildings through its hierarchy and provides semantic information that helps with localization, like poses of doors and glass. In contrast to this, commonly used map representations, such as occupancy grid maps or point clouds, lack these features and require frequent updates in response to environmental changes (e.g. moved furniture), unlike our approach, which matches against lifelong architectural features such as walls and doors. For that we apply filtering to remove clutter from the 3D input point cloud and then employ further scoring and weight functions for localization. Given a broad initial guess from WiFi localization, our experiments show that our global localization and the weighted point to line ICP pose tracking perform very well, even when compared to localization and SLAM algorithms that use the current, feature-rich cluttered map for localization.
BibTeX
@article{xie2024robust,
  author = {Fujing Xie and Sören Schwertfeger},
  title = {{Robust Lifelong Indoor LiDAR Localization using the Area Graph}},
  journal = {IEEE Robotics Autom. Lett.},
  year = {2024},
  url = {https://openreview.net/forum?id=xNP3NxFZFK},
}
Figure