Accurate Gaussian-Process-based Distance Fields with applications to Echolocation and Mapping (2302.13005v3)
Abstract: This paper introduces a novel method to estimate distance fields from noisy point clouds using Gaussian Process (GP) regression. Distance fields, or distance functions, gained popularity for applications like point cloud registration, odometry, SLAM, path planning, shape reconstruction, etc. A distance field provides a continuous representation of the scene defined as the shortest distance from any query point and the closest surface. The key concept of the proposed method is the transformation of a GP-inferred latent scalar field into an accurate distance field by using a reverting function related to the kernel inverse. The latent field can be interpreted as a smooth occupancy map. This paper provides the theoretical derivation of the proposed method as well as a novel uncertainty proxy for the distance estimates. The improved performance compared with existing distance fields is demonstrated with simulated experiments. The level of accuracy of the proposed approach enables novel applications that rely on precise distance estimation: this work presents echolocation and mapping frameworks for ultrasonic-guided wave sensing in metallic structures. These methods leverage the proposed distance field with a physics-based measurement model accounting for the propagation of the ultrasonic waves in the material. Real-world experiments are conducted to demonstrate the soundness of these frameworks.
- C. Cadena, L. Carlone, H. Carrillo, Y. Latif, D. Scaramuzza, J. Neira, I. Reid, and J. J. Leonard, “Past, present, and future of simultaneous localization and mapping: Toward the robust-perception age,” IEEE Transactions on Robotics, vol. 32, no. 6, pp. 1309–1332, 2016.
- R. Mur-Artal and J. D. Tardós, “ORB-SLAM2: an open-source SLAM system for monocular, stereo, and RGB-D cameras,” IEEE Transactions on Robotics (T-RO), vol. 33, no. 5, pp. 1255–1262, 2017.
- A. Elfes, “Using occupancy grids for mobile robot perception and navigation,” Computer, vol. 22, no. 6, pp. 46–57, 1989.
- A. Hornung, K. M. Wurm, M. Bennewitz, C. Stachniss, and W. Burgard, “Octomap: an efficient probabilistic 3d mapping framework based on octrees,” Autonomous Robots, pp. 189–206, 2013.
- E. G. Tsardoulias, A. Iliakopoulou, A. Kargakos, and L. Petrou, “A review of global path planning methods for occupancy grid maps regardless of obstacle density,” Int. J. of Rob. Res.(IJRR), 2016.
- S. Izadi, D. Kim, O. Hilliges, D. Molyneaux, R. Newcombe, P. Kohli, J. Shotton, S. Hodges, D. Freeman, A. Davison, et al., “Kinectfusion: real-time 3d reconstruction and interaction using a moving depth camera,” in Proc. of the ACM symposium, 2011, pp. 559–568.
- H. Oleynikova, A. Millane, Z. Taylor, E. Galceran, J. Nieto, and R. Siegwart, “Signed distance fields: A natural representation for both mapping and planning,” in RSS 2016 Workshop: Geometry and Beyond-Representations, Physics, and Scene Understanding for Robotics, 2016.
- H. Oleynikova, Z. Taylor, M. Fehr, R. Siegwart, and J. Nieto, “Voxblox: Incremental 3d euclidean signed distance fields for on-board mav planning,” in 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2017, pp. 1366–1373.
- L. Han, F. Gao, B. Zhou, and S. Shen, “Fiesta: Fast incremental euclidean distance fields for online motion planning of aerial robots,” in 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2019, pp. 4423–4430.
- J. Ortiz, A. Clegg, J. Dong, E. Sucar, D. Novotny, M. Zollhoefer, and M. Mukadam, “isdf: Real-time neural signed distance fields for robot perception,” arXiv preprint arXiv:2204.02296, 2022.
- E. Sucar, S. Liu, J. Ortiz, and A. J. Davison, “imap: Implicit mapping and positioning in real-time,” in Proceedings of the IEEE/CVF International Conference on Computer Vision, 2021, pp. 6229–6238.
- Z. Zhu, S. Peng, V. Larsson, W. Xu, H. Bao, Z. Cui, M. R. Oswald, and M. Pollefeys, “Nice-slam: Neural implicit scalable encoding for slam,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, 2022, pp. 12 786–12 796.
- D. Driess, J.-S. Ha, M. Toussaint, and R. Tedrake, “Learning models as functionals of signed-distance fields for manipulation planning,” in Conference on Robot Learning. PMLR, 2022, pp. 245–255.
- M. Pantic, C. Cadena, R. Siegwart, and L. Ott, “Sampling-free obstacle gradients and reactive planning in neural radiance fields (nerf),” arXiv preprint arXiv:2205.01389, 2022.
- O. Williams and A. Fitzgibbon, “Gaussian process implicit surfaces,” 2007.
- L. Wu, K. M. B. Lee, L. Liu, and T. Vidal-Calleja, “Faithful euclidean distance field from log-gaussian process implicit surfaces,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 2461–2468, 2021.
- L. Wu, K. M. B. Lee, C. Le Gentil, and T. Vidal-Calleja, “Log-gpis-mop: A unified representation for mapping, odometry, and planning,” IEEE Transactions on Robotics, pp. 1–17, 2023.
- J.-P. A. Ivan, T. Stoyanov, and J. A. Stork, “Online distance field priors for gaussian process implicit surfaces,” IEEE Robotics and Automation Letters, vol. 7, no. 4, pp. 8996–9003, 2022.
- I. Dokmanić, L. Daudet, and M. Vetterli, “From acoustic room reconstruction to slam,” in 2016 IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP). Ieee, 2016, pp. 6345–6349.
- M. Kreković, I. Dokmanić, and M. Vetterli, “Echoslam: Simultaneous localization and mapping with acoustic echoes,” in 2016 IEEE International Conference on Acoustics, Speech and Signal Processing (ICASSP). Ieee, 2016, pp. 11–15.
- D. Ribas, P. Ridao, J. D. Tardós, and J. Neira, “Underwater slam in a marina environment,” in 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems. IEEE, 2007, pp. 1455–1460.
- M. Y. Cheung, D. Fourie, N. R. Rypkema, P. V. Teixeira, H. Schmidt, and J. Leonard, “Non-gaussian slam utilizing synthetic aperture sonar,” in 2019 International Conference on Robotics and Automation (ICRA). IEEE, 2019, pp. 3457–3463.
- R. Worley, Y. Yu, and S. Anderson, “Acoustic echo-localization for pipe inspection robots,” in 2020 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI). IEEE, 2020, pp. 160–165.
- O. L. Ouabi, P. Pomarede, M. Geist, N. F. Declercq, and C. Pradalier, “A FastSLAM Approach Integrating Beamforming Maps for Ultrasound-Based Robotic Inspection of Metal Structures,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 2908–2913, 2021.
- W. Martens, Y. Poffet, P. R. Soria, R. Fitch, and S. Sukkarieh, “Geometric priors for gaussian process implicit surfaces,” IEEE Robotics and Automation Letters, vol. 2, no. 2, pp. 373–380, 2017.
- S. Särkkä, “Linear operators and stochastic partial differential equations in Gaussian process regression,” Artificial Neural Networks and Machine Learning–ICANN 2011, pp. 151–158, 2011.
- K. Crane, C. Weischedel, and M. Wardetzky, “Geodesics in heat: A new approach to computing distance based on heat flow,” ACM Transactions on Graphics (TOG), vol. 32, no. 5, October 2013.
- S. R. S. Varadhan, “On the behavior of the fundamental solution of the heat equation with variable coefficients,” Communications on Pure and Applied Mathematics, vol. 20, pp. 431–455, 1967.
- A. McHutchon and C. E. Rasmussen, “Gaussian process training with input noise,” in Proceedings of the 24th International Conference on Neural Information Processing Systems, ser. NIPS’11. Red Hook, NY, USA: Curran Associates Inc., 2011, p. 1341–1349.
- W. E. Lorensen and H. E. Cline, “Marching cubes: A high resolution 3d surface construction algorithm,” ACM siggraph computer graphics, no. 4, pp. 163–169, 1987.
- J. Sturm, N. Engelhard, F. Endres, W. Burgard, and D. Cremers, “A benchmark for the evaluation of RGB-D SLAM systems,” IEEE International Conference on Intelligent Robots and Systems, pp. 573–580, 2012.
- O.-L. Ouabi, P. Pomarede, M. Geist, N. F. Declercq, and C. Pradalier, “Monte-carlo localization on metal plates based on ultrasonic guided waves,” in International Symposium on Experimental Robotics. Springer, 2021, pp. 345–353.