Constraint-Based Modeling of Dynamic Entities in 3D Scene Graphs for Robust SLAM