Mobile Robot Localization in 3D Triangle Meshes & Geometric Scene Graphs - View it on GitHub