cs.ROJan 22, 2025

Grid-based Submap Joining: An Efficient Algorithm for Simultaneously Optimizing Global Occupancy Map and Local Submap Frames

Authors: Yingyu Wang, Liang Zhao, Shoudong Huang

Organizations: Robotics Institute, Faculty of Engineering and Information Technology, University of Technology Sydney, Australia · School of Informatics, University of Edinburgh, Edinburgh, UK

Abstract

Optimizing robot poses and the map simultaneously has been shown to provide more accurate SLAM results. However, for non-feature based SLAM approaches, directly optimizing all the robot poses and the whole map will greatly increase the computational cost, making SLAM problems difficult to solve in large-scale environments. To solve the 2D non-feature based SLAM problem in large-scale environments more accurately and efficiently, we propose the grid-based submap joining method. Specifically, we first formulate the 2D grid-based submap joining problem as a non-linear least squares (NLLS) form to optimize the global occupancy map and local submap frames simultaneously. We then prove that in solving the NLLS problem using Gauss-Newton (GN) method, the increments of the poses in each iteration are independent of the occupancy values of the global occupancy map. Based on this property, we propose a poseonly GN algorithm equivalent to full GN method to solve the NLLS problem. The proposed submap joining algorithm is very efficient due to the independent property and the pose-only solution. Evaluations using simulations and publicly available practical 2D laser datasets confirm the outperformance of our proposed method compared to the state-of-the-art methods in terms of efficiency and accuracy, as well as the ability to solve the grid-based SLAM problem in very large-scale environments.

Figures & tables

Explore similar work

Jun 9, 2026

Large-Scale Continuous Occupancy Mapping via Variance-Weighted Submap Joining

Continuous occupancy mapping methods that learn spatial representations from sensor observations support predictions at arbitrary locations, but training a single global model can become computationally expensive as the amount of training data grows during large-scale mapping. Constructing local continuous occupancy submaps reduces the size of individual learning problems, but relative pose errors can cause inconsistent predictions in overlapping regions. We address these challenges by formulating large-scale continuous occupancy mapping as a submap joining problem. Each local submap is represented by a relevance vector machine regressing a continuous average log-odds field. Repeated observations within each cell are summarized by their average log-odds and observation count, yielding a Gaussian likelihood with count-dependent precision and enabling Gaussian-conjugate inference. The resulting local fields provide predictive means, variances, and analytical spatial derivatives. We then formulate submap joining as a joint pose--field optimization problem, with consistency constraints weighted by the predictive uncertainty of overlapping local submaps. With uncertainty weights held fixed within each Gauss--Newton iteration, our joint pose--field system can be reduced to an equivalent pose-only system. After the optimized submap poses are obtained, the global field value at any covered location can be recovered in closed form through variance-weighted fusion of predictions from the corresponding local submaps, without training an additional global model. Experiments on simulated and real-world 2D LiDAR datasets demonstrate improved pose and occupancy-map accuracy over the evaluated baselines, reduced map storage and joining time, and improved map-construction scalability.
Aug 10, 2026

Multi-Submap Implicit Neural SLAM with Local-to-Global Loop Closure for Large-Scale Scene Reconstruction

Neural Radiance Fields (NeRF)-based SLAM has demonstrated impressive results in small-scale scene reconstruction, yet scaling these methods to extensive, complex environments remains challenging due to catastrophic forgetting and accumulated trajectory drift. This paper presents a robust, large-scale neural SLAM system featuring a multi-submap architecture and a dual-tier loop closure mechanism. Specifically, we propose a progressive mapping strategy that dynamically allocates neural submaps to maintain high-fidelity representations without memory explosion. For robust pose estimation, an optical-flow-based tracking module is integrated to handle aggressive motions. To address global consistency, we introduce a local-to-global loop closure framework leveraging the foundation model for high-performance global descriptor extraction, significantly enhancing relocalization accuracy under varying viewpoints. Furthermore, an inter-submap online distillation algorithm is designed during back-end optimization to enforce geometric and appearance consistency across overlapping submap boundaries. To validate the system, we developed a customized handheld mechatronic platform and conducted extensive evaluations on both public benchmarks and our large-scale indoor-outdoor datasets. Experimental results, including direct deployment on an onboard computing unit, demonstrate that our approach outperforms state-of-the-art neural SLAM methods in reconstruction quality and localization robustness, providing a scalable solution for real-world robotic perception and digital twinning. We will release the code publicly on https://github.com/dtc111111/MSN-SLAM .
Apr 14, 2026

RMGS-SLAM: Real-time Multi-sensor Gaussian Splatting SLAM

Achieving real-time Simultaneous Localization and Mapping (SLAM) based on 3D Gaussian splatting (3DGS) in large-scale real-world environments remains challenging, as existing methods still struggle to jointly achieve low-latency pose estimation, continuous 3D Gaussian reconstruction, and long-term global consistency. In this paper, we present a tightly coupled LiDAR-Inertial-Visual 3DGS-based SLAM framework for real-time pose estimation and photorealistic mapping in large-scale real-world scenes. The system executes state estimation and 3D Gaussian primitive initialization in parallel with global Gaussian optimization, enabling continuous dense mapping. To improve Gaussian initialization quality and accelerate optimization convergence, we introduce a cascaded strategy that combines feed-forward predictions with geometric priors derived from voxel-based principal component analysis. To enhance global consistency, we perform loop closure directly on the optimized global Gaussian map by estimating loop constraints through Gaussian-based Generalized Iterative Closest Point registration, followed by pose-graph optimization. We also collect challenging large-scale looped outdoor sequences with hardware-synchronized LiDAR-camera-IMU and ground-truth trajectories for realistic evaluation. Extensive experiments on both public datasets and our dataset demonstrate that the proposed method achieves a state of the art among real-time efficiency, localization accuracy, and rendering quality across diverse real-world scenes.