Abstract
This paper presents a real-time viable method for Simultaneous Localization and Mapping (SLAM) using Gaussian mixture models (GMMs) for compute-constrained systems that operate in subterranean environments. The two contributions of this work are (1) a SLAM formulation that uses a GMM-based map representation for pose estimation, mapping and loop closure, and (2) an Expectation Maximization (EM) formulation that significantly reduces the time to learn a GMM from a sensor observation by exploiting the insight that although Gaussian distributions have infinite support, a substantial amount of the support is contained within a finite region. An on-manifold distribution-to-distribution registration approach is used to estimate the pose between consecutive GMMs, and the Cauchy–Schwarz divergence is employed to calculate the difference between the distributions to identify loop closures. The method is evaluated in mine and unstructured cave environments. The results demonstrate superior performance in leveraging the compact representation of the GMM as compared to traditional pose graph SLAM techniques that rely on point cloud-based methods. Further, exploiting the sparsity of the compact support significantly reduces training time toward enabling real-time viability.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
References
Arthur, D., Vassilvitskii, S.: k-means++: the advantages of careful seeding. In : Proceedings of the 18th Annual ACM-SIAM Symposium on Discrete Algorithms, pp. 1027–1035, Jan 2007. https://doi.org/10.1145/1283383.1283494
Behley, J., Stachniss, C.: Efficient surfel-based slam using 3d laser range data in urban environments. Robotics: Science and Systems (2018). https://doi.org/10.15607/RSS.2018.XIV.016
Bilmes, J.A.: A gentle tutorial of the em algorithm and its application to parameter estimation for gaussian mixture and hidden markov models. Intl. Comput. Sci. Inst. 4(510), 126 (1998)
Bishop, C.: Pattern Recognition and Machine Learning, 2nd edn. Springer-Verlag, New York, New York (2007)
Boumal, N., Mishra, B., Absil, P.A., Sepulchre, R.: Manopt, a matlab toolbox for optimization on manifolds. J. Mach. Learn. Res. 15(1), 1455–1459 (2014)
Curtin, R.R.: A dual-tree algorithm for fast k-means clustering with large k. In: Proceedings of the 2017 SIAM International Conference on Data Mining, pp. 300–308 (2017). https://doi.org/10.1137/1.9781611974973.34
Dellaert, F.: Factor graphs and gtsam: A hands-on introduction. Technical report, Georgia Institute of Technology (2012)
Eckart, B., Kim, K., Troccoli, A., Kelly, A., Kautz, J.: Accelerated generative models for 3d point cloud data. In: Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition, pp. 5497–5505 (2016). https://doi.org/10.1109/CVPR.2016.593
Eckart, B., Kim, K., Kautz, J.: Hgmr: Hierarchical gaussian mixtures for adaptive 3d registration. In: Proceedings of the European Conference on Computer Vision (ECCV), pp. 705–721 (2018). https://doi.org/10.1007/978-3-030-01267-0_43
Eckart, B.: compact generative models of point cloud data for 3D perception. Ph.D. thesis, Pittsburgh, PA (2017)
Elkan, C.: Using the triangle inequality to accelerate k-means. In: Proceedings of the 20th international conference on Machine Learning (ICML-03), pp. 147–153, Aug 2003
Dimitrios Evangelidis, G., Horaud, R.: Joint alignment of multiple point sets with batch and incremental expectation-maximization. IEEE Trans. Pattern Anal. Mach. Intell. 40(6), 1397–1410 (2018). https://doi.org/10.1109/TPAMI.2017.2717829
Greg Hamerly. Making k-means even faster. In: Proceedings of the 2010 SIAM International Conference on Data Mining, pp. 130–140 (2010). https://doi.org/10.1137/1.9781611972801.12
Hosseini, R., Sra S.: An alternative to em for gaussian mixture models: Batch and stochastic riemannian optimization. arXiv preprint . arXiv:1706.03267 (2017)
Jian, B., Vemuri, B.C.: Robust point set registration using gaussian mixture models. IEEE Trans. Pattern Anal. Mach. Intell. 33(8), 1633–1645 (2011). https://doi.org/10.1109/TPAMI.2010.223
Kaess, M., Johannsson, H., Roberts, R., Ila, V., Leonard, J.J., Dellaert, F.: isam2: incremental smoothing and mapping using the bayes tree. J. Intl. Robot. Res 31(2), 216–235 (2012). https://doi.org/10.1177/0278364911430419
Kampa K., Hasanbelliu E., Principe, J.C.: Closed-form cauchy-schwarz pdf divergence for mixture of gaussians. In: Proceedings of The 2011 International Joint Conference on Neural Networks, pp. 2578–2585 (2011). https://doi.org/10.1109/IJCNN.2011.6033555
Kolouri, S., Rohde G.K., Hoffmann, H.: Sliced wasserstein distance for learning gaussian mixture models. In: Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition, pp. 3427–3436, June 2018. https://doi.org/10.1109/CVPR.2018.00361
Liu, Y., Nejat, G.: Robotic urban search and rescue: a survey from the control perspective. J. of Intell. Robot. Syst. 72(2), 147–165 (2013). https://doi.org/10.1007/s10846-013-9822-x
O’Reilly, G., Jrad, A., Nagarajan, R., Brown, T., Conrad. Critical infrastructure analysis of telecom for natural disasters. In: Networks 2006. 12th International Telecommunications Network Strategy and Planning Symposium, pp. 1–6, (2006). https://doi.org/10.1109/NETWKS.2006.300396
O’Meadhra, C., Tabib, W., Michael, N.: Variable resolution occupancy mapping using gaussian mixture models. IEEE Robot. and Autom. Lett. 4(2), 2015–2022 (2019). https://doi.org/10.1109/LRA.2018.2889348. Apr
Segal, A., Haehnel, D., Thrun, S.: Generalized-icp. Robotics: Science and Systems (2009). https://doi.org/10.15607/RSS.2009.V.021
Srivastava, S., Michael, N.: Efficient, multifidelity perceptual representations via hierarchical gaussian mixture models. IEEE Trans. Robot. 35(1), 248–260 (2019). https://doi.org/10.1109/TRO.2018.2878363
Stoyanov, T., Magnusson, M., Lilienthal, A.J.: Point set registration through minimization of the l 2 distance between 3d-ndt models. In: 2012 IEEE International Conference on Robotics and Automation, pp. 5196–5201 (2012). https://doi.org/10.1109/ICRA.2012.6224717
Sturm, J., Engelhard, N., Endres, F., Burgard, W., Cremers, D.: A benchmark for the evaluation of rgb-d slam systems. In: 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems, Oct 2012. https://doi.org/10.1109/IROS.2012.6385773
Tabib, W., O’Meadhra, C., Michael, N.: On-manifold gmm registration. IEEE Robot. Autom. Lett. 3(4), 3805–3812 (2018). https://doi.org/10.1109/LRA.2018.2856279
Tabib, W., Goel, K., Yao, J., Dabhi, M., Boirum, C., Michael, N.: Real-time information-theoretic exploration with gaussian mixture model maps. In: Robotics: Science and Systems, FreiburgimBreisgau, Germany, June 2019. https://doi.org/10.15607/RSS.2019.XV.061
Acknowledgements
The authors would like to thank Aditya Dhawale, Alexander Spitzer, and Kumar Shaurya Shankar for providing feedback on drafts of this manuscript. The authors would also like to thank Curtis Boirum and Brian Osbun for assisting in data collection at Rapps Cave as well as Carroll Bassett of the West Virginia Cave Conservancy for granting access to Rapps Cave.
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2021 Springer Nature Singapore Pte Ltd.
About this paper
Cite this paper
Tabib, W., Michael, N. (2021). Simultaneous Localization and Mapping of Subterranean Voids with Gaussian Mixture Models. In: Ishigami, G., Yoshida, K. (eds) Field and Service Robotics. Springer Proceedings in Advanced Robotics, vol 16. Springer, Singapore. https://doi.org/10.1007/978-981-15-9460-1_13
Download citation
DOI: https://doi.org/10.1007/978-981-15-9460-1_13
Published:
Publisher Name: Springer, Singapore
Print ISBN: 978-981-15-9459-5
Online ISBN: 978-981-15-9460-1
eBook Packages: Intelligent Technologies and RoboticsIntelligent Technologies and Robotics (R0)