DYNEMO-SLAM: Dynamic Entity and Motion-Aware 3D Scene Graph SLAM

Fuente: arXiv
Saved in:
Bibliographic Details
Main Authors: Giberna, Marco, Shaheer, Muhammad, Fernandez-Cortizas, Miguel, Millan-Romera, Jose Andres, Sanchez-Lopez, Jose Luis, Voos, Holger
Format: Preprint
Published: 2025
Subjects:
Online Access:
Tags: Add Tag
No Tags, Be the first to tag this record!
_version_ 1866909939192037376
author Giberna, Marco
Shaheer, Muhammad
Fernandez-Cortizas, Miguel
Millan-Romera, Jose Andres
Sanchez-Lopez, Jose Luis
Voos, Holger
author_facet Giberna, Marco
Shaheer, Muhammad
Fernandez-Cortizas, Miguel
Millan-Romera, Jose Andres
Sanchez-Lopez, Jose Luis
Voos, Holger
contents Robots operating in dynamic environments face significant challenges due to the presence of moving agents and displaced objects. Traditional SLAM systems typically assume a static world or treat dynamic as outliers, discarding their information to preserve map consistency. As a result, they cannot exploit dynamic entities as persistent landmarks, do not model and exploit their motion over time, and therefore quickly degrade in highly cluttered environments with few reliable static features. This paper presents a novel 3D scene graph-based SLAM framework that addresses the challenge of modeling and estimating the pose of dynamic entities into the SLAM backend. Our framework incorporates semantic motion priors and dynamic entity-aware constraints to jointly optimize the robot trajectory, dynamic entity poses, and the surrounding environment structure within a unified graph formulation. In parallel, a dynamic keyframe selection policy and a semantic loop-closure prefiltering step enable the system to remain robust and effective in highly dynamic environments by continuously adapting to scene changes and filtering inconsistent observations. The simulation and real-world experimental results show a 49.97% reduction in ATE compared to the baseline method employed, demonstrating the effectiveness of incorporating dynamic entities and estimating their poses for improved robustness and richer scene representation in complex scenarios while maintaining real-time performance.
format Preprint
id arxiv_https___arxiv_org_abs_2503_02050
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle DYNEMO-SLAM: Dynamic Entity and Motion-Aware 3D Scene Graph SLAM
Giberna, Marco
Shaheer, Muhammad
Fernandez-Cortizas, Miguel
Millan-Romera, Jose Andres
Sanchez-Lopez, Jose Luis
Voos, Holger
Robotics
Robots operating in dynamic environments face significant challenges due to the presence of moving agents and displaced objects. Traditional SLAM systems typically assume a static world or treat dynamic as outliers, discarding their information to preserve map consistency. As a result, they cannot exploit dynamic entities as persistent landmarks, do not model and exploit their motion over time, and therefore quickly degrade in highly cluttered environments with few reliable static features. This paper presents a novel 3D scene graph-based SLAM framework that addresses the challenge of modeling and estimating the pose of dynamic entities into the SLAM backend. Our framework incorporates semantic motion priors and dynamic entity-aware constraints to jointly optimize the robot trajectory, dynamic entity poses, and the surrounding environment structure within a unified graph formulation. In parallel, a dynamic keyframe selection policy and a semantic loop-closure prefiltering step enable the system to remain robust and effective in highly dynamic environments by continuously adapting to scene changes and filtering inconsistent observations. The simulation and real-world experimental results show a 49.97% reduction in ATE compared to the baseline method employed, demonstrating the effectiveness of incorporating dynamic entities and estimating their poses for improved robustness and richer scene representation in complex scenarios while maintaining real-time performance.
title DYNEMO-SLAM: Dynamic Entity and Motion-Aware 3D Scene Graph SLAM
topic Robotics
url https://arxiv.org/abs/2503.02050