Comparative Evaluation of RGB-D SLAM Methods for Humanoid Robot Localization and Mapping
Amirhosein Vedadi, Aghil Yousefi-Koma, Parsa Yazdankhah, Amin Mozayyan
TL;DR
The paper addresses the challenge of robust localization and mapping for humanoid robots by benchmarking three RGB-D SLAM systems—RTAB-Map, ORB-SLAM3, and OpenVSLAM—on the SURENA-V platform using a RealSense D435. It provides a detailed comparison of localization accuracy, loop-closure behavior, and mapping outputs, revealing that ORB-SLAM3 achieves the lowest Absolute Trajectory Error (ATE) while RTAB-Map offers the most versatile mapping outputs (dense maps, OctoMap, and occupancy grids). OpenVSLAM demonstrates loop-closure-based relocalization but can struggle with odometry in feature-scarce or high-motion scenarios. The results inform practitioners about trade-offs between localization precision and mapping richness, guiding algorithm choice for humanoid autonomy depending on task priorities.
Abstract
In this paper, we conducted a comparative evaluation of three RGB-D SLAM (Simultaneous Localization and Mapping) algorithms: RTAB-Map, ORB-SLAM3, and OpenVSLAM for SURENA-V humanoid robot localization and mapping. Our test involves the robot to follow a full circular pattern, with an Intel RealSense D435 RGB-D camera installed on its head. In assessing localization accuracy, ORB-SLAM3 outperformed the others with an ATE of 0.1073, followed by RTAB-Map at 0.1641 and OpenVSLAM at 0.1847. However, it should be noted that both ORB-SLAM3 and OpenVSLAM faced challenges in maintaining accurate odometry when the robot encountered a wall with limited feature points. Nevertheless, OpenVSLAM demonstrated the ability to detect loop closures and successfully relocalize itself within the map when the robot approached its initial location. The investigation also extended to mapping capabilities, where RTAB-Map excelled by offering diverse mapping outputs, including dense, OctoMap, and occupancy grid maps. In contrast, both ORB-SLAM3 and OpenVSLAM provided only sparse maps.
