CAOS-SLAM: Class-Agnostic Object-Aware Real-Time vSLAM for Dynamic Environments
Organizations: Dynamic Legged Systems Lab (DLS), Istituto Italiano di Tecnologia, Genoa, Italy · Section of Automation & Control, Department of Electronic Systems, Aalborg University, Denmark
Abstract
Robust visual Simultaneous Localization and Mapping (vSLAM) in dynamic environments faces challenges due to the presence of moving objects that may introduce erroneous observations, corrupt the map reconstruction and overall degrade localization accuracy. Existing vSLAM approaches often rely on predefined semantic classes or costly pixel-wise classification, limiting their robustness or applicability in real-world scenarios. This paper presents CAOS-SLAM, a dynamic vSLAM framework that extends ORB-SLAM3 with a hybrid perception pipeline to detect, track, and filter both semantically known and previously unseen moving objects in real-time. On-demand panoptic segmentation is performed for object discovery, with candidate unknown objects instantiated through depth-based clustering of unclassified regions. Between panoptic updates, persistent object tracks are updated using lightweight detection when available or temporal mask propagation based on world-frame Kalman prediction, depth consistency, and appearance similarity. The estimated object motion is then used to reject dynamic features from the SLAM pipeline. Experimental results on multiple dynamic RGB-D datasets and real-world experiments demonstrate improved localization accuracy over state-of-the-art dynamic vSLAM approaches, achieving up to 59% lower localization error in scenes characterized by unknown dynamic objects and up to 88% lower error in heavily occluded scenes, while achieving a median processing rate of 30 FPS on a laptop. Furthermore, the tracking module provides estimates of object trajectories and velocities, supporting potential future applications in perception, navigation, and motion-planning tasks in dynamic environments. Code and dataset will be released upon acceptance.
Figures & tables
| Parameter | Meaning | Value |
| Intersection Over Union Threshold | 0.3 | |
| Object velocity hysteresis factor | 0.8 | |
| Sharpness transition factor | 8.0 | |
| Characteristic depth where the transition occurs | 2.75 m | |
| Sensitivity for near objects | 0.15 m/s | |
| Maximum tolerance for far objects | 0.40 m/s |
| Sequence | ORB- SLAM3 | Panoptic- SLAM | NGD- SLAM | Only Panoptic | CAOS-SLAM (Ours) |
| Bonn - Non-Obstructing Box | |||||
| Moving | 0.3775 | 0.0273 | 0.0211 | 0.1271 | 0.0272 |
| Moving 2 | 0.0411 | 0.0329 | 0.0395 | 0.0423 | 0.0345 |
| Placing | 0.8513 | 0.0686 | 0.3479 | 0.0405 | 0.0405 |
| Placing 2 | 0.0220 | 0.0235 | 0.0181 | 0.0262 | 0.0241 |
| Placing 3 | 0.2402 | 0.0299 | 0.0354 | 0.0338 | 0.0349 |
| ORB- SLAM3 | Panoptic- SLAM | NGD- SLAM | Only Panoptic | CAOS-SLAM (Ours) | |
| Median FPS | 49.33 | 2.618 | 82.64 | 2.207 | 30.61 |
| Mean FPS | 50.35 | 2.583 | 97.72 | 2.189 | 24.73 |
| Sequences | ORB- SLAM3 | Panoptic- SLAM | NGD- SLAM | CAOS-SLAM (Ours) |
| baseline | 0.0182 | 0.0232 | 0.0296 | 0.0198 |
| B2 move | 0.0425 | 0.0177 | 0.0224 | 0.0189 |
| B2 follow | 0.7330 | 0.7236 | 0.6779 | 0.1754 |
| person move | 0.3495 | - | 0.0915 | 0.0751 |
| person random | 0.3824 | 0.0235 | 0.0210 | 0.0317 |
| person follow | 0.6321 | 0.4154 | 0.2068 | 0.0375 |
| Sequence | B2 | Go2 | Person |
| baseline | 0.2383 | 0.0762 | - |
| B2 move | 0.2315 | - | - |
| B2 follow | 0.3799 | 0.1367 | - |
| person move | - | - | 0.0652 |
| person random | - | - | 0.1702 |
| person follow | - | - | 0.2644 |
Visual SLAM
Visual simultaneous localization and mapping (SLAM) estimates camera motion while building maps from images for navigation and scene understanding.
See all 103 papers