Submitted:
26 June 2026
Posted:
26 June 2026
You are already at the latest version
Abstract
Keywords:
1. Introduction
- A robust local HBA frontend is developed for repetitive and locally degenerate ship-interior geometry by combining residual-adaptive weighting, pose-step clamping, damping, and soft fallback.
- A factorization-free global backend is formulated directly on the whitened sparse least-squares system and solved through CSR-based row projections without explicitly forming the approximate Hessian or a Cholesky factor.
- Local-map compression, keyframe regulation, and optimization-range control are co-designed with the numerical backend to bound the problem presented to the solver.
- The complete architecture is evaluated on NTNU Ballast Water Tank missions 1–3 using absolute and path-normalized trajectory errors.
2. Materials and Methods
2.1. System Architecture and Onboard Design Objective
2.2. Robust Hierarchical Bundle Adjustment Frontend
2.2.1. Local Window Formulation
2.2.2. Residual-Dependent Weight Reduction
2.2.3. Damping and Pose-Step Clamping
2.2.4. Soft Fallback
2.2.5. Local-Map Compression
2.3. Global Graph SLAM Formulation
2.4. CSR-Based Kaczmarz Backend
2.5. Structural Memory Model and Memory Guard
2.6. Experimental Data and Evaluation Protocol
2.7. Use of Generative Artificial Intelligence in Manuscript Preparation
3. Results
3.1. NTNU Ballast Water Tank Mission Scale
3.2. Trajectory Accuracy of the Baseline and Robust Local BA Configurations
3.3. Structural Behavior of the Kaczmarz Backend
3.4. System-Level Memory Operating Points
4. Discussion
4.1. Significance for Marine Inspection Robotics
4.2. Numerical Architecture and Operating-Policy Co-Design
4.3. Interpretation of Onboard Feasibility
4.4. Limitations and Future Work
5. Conclusions
Author Contributions
Funding
Institutional Review Board Statement
Informed Consent Statement
Data Availability Statement
Acknowledgments
Conflicts of Interest
References
- Dharmadhikari, M.; De Petris, P.; Kulkarni, M.; Khedekar, N.; Nguyen, H.; Stene, A.E.; Sjøvold, E.; Solheim, K.; Gussiaas, B.; Alexis, K. Autonomous Exploration and General Visual Inspection of Ship Ballast Water Tanks Using Aerial Robots. In Proceedings of the 2023 21st International Conference on Advanced Robotics, Abu Dhabi, United Arab Emirates, 5–8 December 2023; pp. 409–416. [Google Scholar] [CrossRef]
- Poggi, L.; Gaggero, T.; Gaiotti, M.; Ravina, E.; Rizzo, C.M. Recent Developments in Remote Inspections of Ship Structures. Int. J. Nav. Archit. Ocean Eng. 2020, 12, 881–891. [Google Scholar] [CrossRef]
- Christensen, L.; Fischer, N.; Kroffke, S.; Lemburg, J.; Ahlers, R. Cost-Effective Autonomous Robots for Ballast Water Tank Inspection. J. Ship Prod. Des. 2011, 27, 127–136. [Google Scholar] [CrossRef]
- Cadena, C.; Carlone, L.; Carrillo, H.; Latif, Y.; Scaramuzza, D.; Neira, J.; Reid, I.; Leonard, J.J. Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age. IEEE Trans. Robot. 2016, 32, 1309–1332. [Google Scholar] [CrossRef]
- Durrant-Whyte, H.; Bailey, T. Simultaneous Localization and Mapping: Part I. IEEE Robot. Autom. Mag. 2006, 13, 99–110. [Google Scholar] [CrossRef]
- Zhang, J.; Singh, S. LOAM: Lidar Odometry and Mapping in Real-time. Proceedings of Robotics: Science and Systems, Berkeley, CA, USA, 12–16 July 2014. [Google Scholar] [CrossRef]
- Shan, T.; Englot, B.; Meyers, D.; Wang, W.; Ratti, C.; Rus, D. LIO-SAM: Tightly-Coupled Lidar Inertial Odometry via Smoothing and Mapping. In Proceedings of the 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Virtual Conference, 24 October 2020–24 January 2021; pp. 5135–5142. [Google Scholar] [CrossRef]
- Liu, X.; Liu, Z.; Kong, F.; Zhang, F. Large-Scale LiDAR Consistent Mapping Using Hierarchical LiDAR Bundle Adjustment. IEEE Robot. Autom. Lett. 2023, 8, 1523–1530. [Google Scholar] [CrossRef]
- Dellaert, F.; Kaess, M. Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing. Int. J. Robot. Res. 2006, 25, 1181–1203. [Google Scholar] [CrossRef]
- Kaess, M.; Ranganathan, A.; Dellaert, F. iSAM: Incremental Smoothing and Mapping. IEEE Trans. Robot. 2008, 24, 1365–1378. [Google Scholar] [CrossRef]
- Kaess, M.; Johannsson, H.; Roberts, R.; Ila, V.; Leonard, J.J.; Dellaert, F. iSAM2: Incremental Smoothing and Mapping Using the Bayes Tree. Int. J. Robot. Res. 2012, 31, 216–235. [Google Scholar] [CrossRef]
- Kümmerle, R.; Grisetti, G.; Strasdat, H.; Konolige, K.; Burgard, W. g2o: A General Framework for Graph Optimization. In Proceedings of the 2011 IEEE International Conference on Robotics and Automation, Shanghai, China, 9–13 May 2011; pp. 3607–3613. [Google Scholar] [CrossRef]
- Davis, T.A. Direct Methods for Sparse Linear Systems; SIAM: Philadelphia, PA, USA, 2006. [Google Scholar] [CrossRef]
- Chen, Y.; Davis, T.A.; Hager, W.W.; Rajamanickam, S. Algorithm 887: CHOLMOD, Supernodal Sparse Cholesky Factorization and Update/Downdate. ACM Trans. Math. Softw. 2008, 35, Article 22, 14 pp. [Google Scholar] [CrossRef]
- George, A.; Liu, J.W.H. Computer Solution of Large Sparse Positive Definite Systems; Prentice-Hall: Englewood Cliffs, NJ, USA, 1981; ISBN 978-0-13-165274-3. [Google Scholar]
- NVIDIA Corporation. Jetson Orin Nano Super Developer Kit: Technical Specifications. Available online: https://www.nvidia.com/en-us/autonomous-machines/embedded-systems/jetson-orin/nano-super-developer-kit/ (accessed on 22 June 2026).
- Björck, Å. Numerical Methods for Least Squares Problems; SIAM: Philadelphia, PA, USA, 1996. [Google Scholar] [CrossRef]
- Paige, C.C.; Saunders, M.A. LSQR: An Algorithm for Sparse Linear Equations and Sparse Least Squares. ACM Trans. Math. Softw. 1982, 8, 43–71. [Google Scholar] [CrossRef]
- Fong, D.C.-L.; Saunders, M.A. LSMR: An Iterative Algorithm for Sparse Least-Squares Problems. SIAM J. Sci. Comput. 2011, 33, 2950–2971. [Google Scholar] [CrossRef]
- Saad, Y. Iterative Methods for Sparse Linear Systems, 2nd ed.; SIAM: Philadelphia, PA, USA, 2003. [Google Scholar] [CrossRef]
- Kaczmarz, S. Angenäherte Auflösung von Systemen linearer Gleichungen. Bull. Int. Acad. Pol. Sci. Lett. Cl. Sci. Math. Nat. Sér. A 1937, 355–357. [Google Scholar]
- Strohmer, T.; Vershynin, R. A Randomized Kaczmarz Algorithm with Exponential Convergence. J. Fourier Anal. Appl. 2009, 15, 262–278. [Google Scholar] [CrossRef]
- Needell, D.; Srebro, N.; Ward, R. Stochastic Gradient Descent, Weighted Sampling, and the Randomized Kaczmarz Algorithm. Math. Program. 2016, 155, 549–573. [Google Scholar] [CrossRef]
- Needell, D.; Tropp, J.A. Paved with Good Intentions: Analysis of a Randomized Block Kaczmarz Method. Linear Algebra Appl. 2014, 441, 199–221. [Google Scholar] [CrossRef]
- NTNU Autonomous Robots Laboratory. Ballast Water Tank Dataset. Hugging Face Datasets. Available online: https://huggingface.co/datasets/ntnu-arl/ballast_water_tank_dataset (accessed on 22 June 2026).
- Kim, S.; Hsiao, R.; Nikolić, B.; Demmel, J.; Shao, Y.S. SuperNoVA: Algorithm–Hardware Co-Design for Resource-Aware SLAM. In Proceedings of the 30th ACM International Conference on Architectural Support for Programming Languages and Operating Systems, Rotterdam, The Netherlands, 30 March–3 April 2025; pp. 1035–1051. [Google Scholar] [CrossRef]






|
Dataset |
Frames |
Raw points |
Mean points per frame |
Path length (m) |
Bounding-box diagonal (m) |
| NTNU mission 1 | 851 | 27.9 million | 32.8 thousand | 58.48 | 9.486 |
| NTNU mission 2 | 1202 | 39.4 million | 32.8 thousand | 76.52 | 10.509 |
| NTNU mission 3 | 1084 | 35.5 million | 32.8 thousand | 103.96 | 15.411 |
|
Dataset |
Evaluation state |
RMSE (m) |
Maximum error (m) |
RMSE/path (%) |
RMSE/BBox (%) |
| Mission 1 | Baseline verified trajectory | 0.211 | 0.699 | 0.361 | 2.225 |
| Mission 1 | Robust local BA, verified | 0.080 | 0.163 | 0.137 | 0.843 |
| Mission 2 | Baseline verified trajectory | 0.284 | 1.663 | 0.372 | 2.706 |
| Mission 2 | Robust local BA, verified | 0.110 | 0.181 | 0.144 | 1.047 |
| Mission 3 | Baseline verified trajectory | 0.292 | 1.161 | 0.281 | 1.895 |
| Mission 3 | Robust local BA, verified | 0.127 | 0.184 | 0.122 | 0.824 |
|
Backend |
Storage mode |
Mean residual |
Mean runtime (s) |
Structural memory (MB) |
Working set (MB) |
| Kaczmarz | CSR row-only | 0.158 | 0.1210 | 0.075 | 0.062 |
| LSQR | CSR and CSC transpose cache | 0.011 | 0.0190 | 0.149 | 0.118 |
| PCG | Explicit sparse | 0.011 | 0.0047 | 0.177 | 0.094 |
| Cholesky/LDLT | Explicit and sparse factorization | 0.011 | 0.0015 | 0.346 | 0.056 |
|
Operating point |
Principal settings |
Global BA state | Output poses |
Peak RSS (MB) |
Runtime (s) |
| Memory-priority | Stride 7; leaf 0.8; 50,000-point cap | Disabled | 57 | 165.1 | 6.585 |
| Balanced | Stride 5; leaf 0.8; 50,000-point cap; 20-pose limit | Skipped by range guard | 135 | 178.5 | 13.56 |
| Quality-priority | Stride 5; leaf 0.2; 100,000-point cap; 100-pose limit | Skipped by range guard | 135 | 411.4 | 20.58 |
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content. |
© 2026 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (http://creativecommons.org/licenses/by/4.0/).