Skip to main content
Top

2019 | OriginalPaper | Chapter

MC2SLAM: Real-Time Inertial Lidar Odometry Using Two-Scan Motion Compensation

Authors : Frank Neuhaus, Tilman Koß, Robert Kohnen, Dietrich Paulus

Published in: Pattern Recognition

Publisher: Springer International Publishing

Activate our intelligent search to find suitable subject content or patents.

search-config
loading …

Abstract

We propose a real-time, low-drift laser odometry approach that tightly integrates sequentially measured 3D multi-beam LIDAR data with inertial measurements. The laser measurements are motion-compensated using a novel algorithm based on non-rigid registration of two consecutive laser sweeps and a local map. IMU data is being tightly integrated by means of factor-graph optimization on a pose graph. We evaluate our method on a public dataset and also obtain results on our own datasets that contain information not commonly found in existing datasets. At the time of writing, our method was ranked within the top five laser-only algorithms of the KITTI odometry benchmark.

Dont have a licence yet? Then find out more about our products and how to get one now:

Springer Professional "Wirtschaft+Technik"

Online-Abonnement

Mit Springer Professional "Wirtschaft+Technik" erhalten Sie Zugriff auf:

  • über 102.000 Bücher
  • über 537 Zeitschriften

aus folgenden Fachgebieten:

  • Automobil + Motoren
  • Bauwesen + Immobilien
  • Business IT + Informatik
  • Elektrotechnik + Elektronik
  • Energie + Nachhaltigkeit
  • Finance + Banking
  • Management + Führung
  • Marketing + Vertrieb
  • Maschinenbau + Werkstoffe
  • Versicherung + Risiko

Jetzt Wissensvorsprung sichern!

Springer Professional "Technik"

Online-Abonnement

Mit Springer Professional "Technik" erhalten Sie Zugriff auf:

  • über 67.000 Bücher
  • über 390 Zeitschriften

aus folgenden Fachgebieten:

  • Automobil + Motoren
  • Bauwesen + Immobilien
  • Business IT + Informatik
  • Elektrotechnik + Elektronik
  • Energie + Nachhaltigkeit
  • Maschinenbau + Werkstoffe




 

Jetzt Wissensvorsprung sichern!

Springer Professional "Wirtschaft"

Online-Abonnement

Mit Springer Professional "Wirtschaft" erhalten Sie Zugriff auf:

  • über 67.000 Bücher
  • über 340 Zeitschriften

aus folgenden Fachgebieten:

  • Bauwesen + Immobilien
  • Business IT + Informatik
  • Finance + Banking
  • Management + Führung
  • Marketing + Vertrieb
  • Versicherung + Risiko




Jetzt Wissensvorsprung sichern!

Appendix
Available only for authorised users
Footnotes
1
Our implementation is also able to close loops, but to maintain focus of this work, we decided to focus on the odometry part of the SLAM problem, whose accuracy is essential to obtain accurate maps—even when loops are being closed.
 
2
At the time of writing, the best method using only laser data was the LOAM method by Zhang and Singh. However, the results reported on the KITTI benchmark webpage are no longer equivalent to those reported in their paper [22], indicating that their solution has been updated. The updated algorithm is no longer publicly available.
 
3
This is relatively efficient, because it is done for the set of query points and not for the whole point cloud.
 
4
Note that we use a log map of \(S^3\) to \(\mathbb {R}^3\) for measuring the ‘difference’ between the orientations [11].
 
7
This number was manually determined to be sufficient to reduce the deviation of the results to negligible values.
 
Literature
2.
go back to reference Besl, P.J., McKay, N.D.: Method for registration of 3-D shapes. In: Sensor Fusion IV: Control Paradigms and Data Structures, vol. 1611, pp. 586–607. International Society for Optics and Photonics (1992) Besl, P.J., McKay, N.D.: Method for registration of 3-D shapes. In: Sensor Fusion IV: Control Paradigms and Data Structures, vol. 1611, pp. 586–607. International Society for Optics and Photonics (1992)
3.
go back to reference Board, I.: IEEE standard specification format guide and test procedure for single-axis interferometric fiber optic gyros. IEEE Std., pp. 952–1997 (1998) Board, I.: IEEE standard specification format guide and test procedure for single-axis interferometric fiber optic gyros. IEEE Std., pp. 952–1997 (1998)
4.
go back to reference Bosse, M., Zlot, R., Flick, P.: Zebedee: design of a spring-mounted 3-D range sensor with application to mobile mapping. IEEE Trans. Robot. 28(5), 1104–1119 (2012)CrossRef Bosse, M., Zlot, R., Flick, P.: Zebedee: design of a spring-mounted 3-D range sensor with application to mobile mapping. IEEE Trans. Robot. 28(5), 1104–1119 (2012)CrossRef
5.
go back to reference Cvišić, I., Petrović, I.: Stereo odometry based on careful feature selection and tracking. In: 2015 European Conference on Mobile Robots, ECMR, pp. 1–6. IEEE (2015) Cvišić, I., Petrović, I.: Stereo odometry based on careful feature selection and tracking. In: 2015 European Conference on Mobile Robots, ECMR, pp. 1–6. IEEE (2015)
8.
go back to reference Geiger, A., Lenz, P., Urtasun, R.: Are we ready for autonomous driving? The KITTI vision benchmark suite. In: Conference on Computer Vision and Pattern Recognition, CVPR (2012) Geiger, A., Lenz, P., Urtasun, R.: Are we ready for autonomous driving? The KITTI vision benchmark suite. In: Conference on Computer Vision and Pattern Recognition, CVPR (2012)
9.
go back to reference Hertzberg, C., Wagner, R., Frese, U., Schröder, L.: Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds. Inf. Fusion 14(1), 57–77 (2013)CrossRef Hertzberg, C., Wagner, R., Frese, U., Schröder, L.: Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds. Inf. Fusion 14(1), 57–77 (2013)CrossRef
10.
go back to reference Hesch, J.A., Kottas, D.G., Bowman, S.L., Roumeliotis, S.I.: Consistency analysis and improvement of vision-aided inertial navigation. IEEE Trans. Robot. 30(1), 158–176 (2014)CrossRef Hesch, J.A., Kottas, D.G., Bowman, S.L., Roumeliotis, S.I.: Consistency analysis and improvement of vision-aided inertial navigation. IEEE Trans. Robot. 30(1), 158–176 (2014)CrossRef
11.
go back to reference Kaess, M.: Simultaneous localization and mapping with infinite planes. In: ICRA, vol. 1, p. 2 (2015) Kaess, M.: Simultaneous localization and mapping with infinite planes. In: ICRA, vol. 1, p. 2 (2015)
12.
go back to reference 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. 31(2), 216–235 (2012)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. 31(2), 216–235 (2012)CrossRef
13.
go back to reference Kukko, A., Kaartinen, H., Hyyppä, J., Chen, Y.: Multiplatform mobile laser scanning: usability and performance. Sensors 12(9), 11712–11733 (2012)CrossRef Kukko, A., Kaartinen, H., Hyyppä, J., Chen, Y.: Multiplatform mobile laser scanning: usability and performance. Sensors 12(9), 11712–11733 (2012)CrossRef
14.
go back to reference Leutenegger, S., Lynen, S., Bosse, M., Siegwart, R., Furgale, P.: Keyframe-based visual–inertial odometry using nonlinear optimization. Int. J. Robot. Res. 34(3), 314–334 (2015)CrossRef Leutenegger, S., Lynen, S., Bosse, M., Siegwart, R., Furgale, P.: Keyframe-based visual–inertial odometry using nonlinear optimization. Int. J. Robot. Res. 34(3), 314–334 (2015)CrossRef
15.
go back to reference Low, K.L.: Linear least-squares optimization for point-to-plane ICP surface registration, no. 4. Chapel Hill, University of North Carolina (2004) Low, K.L.: Linear least-squares optimization for point-to-plane ICP surface registration, no. 4. Chapel Hill, University of North Carolina (2004)
16.
go back to reference Moosmann, F., Stiller, C.: Velodyne SLAM. In: Proceedings of the IEEE Intelligent Vehicles Symposium, pp. 393–398, Baden-Baden, Germany, June 2011 Moosmann, F., Stiller, C.: Velodyne SLAM. In: Proceedings of the IEEE Intelligent Vehicles Symposium, pp. 393–398, Baden-Baden, Germany, June 2011
17.
go back to reference Nüchter, A., Bleier, M., Schauer, J., Janotta, P.: Improving Google’s cartographer 3D mapping by continuous-time SLAM. Int. Arch. Photogram. Remote Sens. Spat. Inf. Sci. 42, 543 (2017)CrossRef Nüchter, A., Bleier, M., Schauer, J., Janotta, P.: Improving Google’s cartographer 3D mapping by continuous-time SLAM. Int. Arch. Photogram. Remote Sens. Spat. Inf. Sci. 42, 543 (2017)CrossRef
19.
go back to reference Rönnholm, P., Liang, X., Kukko, A., Jaakkola, A., Hyyppä, J.: Quality analysis and correction of mobile backpack laser scanning data. ISPRS Ann. Photogram. Remote Sens. Spat. Inf. Sci. 3, 41 (2016)CrossRef Rönnholm, P., Liang, X., Kukko, A., Jaakkola, A., Hyyppä, J.: Quality analysis and correction of mobile backpack laser scanning data. ISPRS Ann. Photogram. Remote Sens. Spat. Inf. Sci. 3, 41 (2016)CrossRef
20.
go back to reference Zhang, J., Kaess, M., Singh, S.: Real-time depth enhanced monocular odometry. In: 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems, IROS 2014, pp. 4973–4980. IEEE (2014) Zhang, J., Kaess, M., Singh, S.: Real-time depth enhanced monocular odometry. In: 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems, IROS 2014, pp. 4973–4980. IEEE (2014)
21.
go back to reference Zhang, J., Kaess, M., Singh, S.: A real-time method for depth enhanced visual odometry. Auton. Robots 41(1), 31–43 (2017)CrossRef Zhang, J., Kaess, M., Singh, S.: A real-time method for depth enhanced visual odometry. Auton. Robots 41(1), 31–43 (2017)CrossRef
22.
go back to reference Zhang, J., Singh, S.: LOAM: lidar odometry and mapping in real-time. In: Robotics: Science and Systems, vol. 2 (2014) Zhang, J., Singh, S.: LOAM: lidar odometry and mapping in real-time. In: Robotics: Science and Systems, vol. 2 (2014)
23.
go back to reference Zhang, J., Singh, S.: Visual-lidar odometry and mapping: low-drift, robust, and fast. In: 2015 IEEE International Conference on Robotics and Automation, ICRA, pp. 2174–2181. IEEE (2015) Zhang, J., Singh, S.: Visual-lidar odometry and mapping: low-drift, robust, and fast. In: 2015 IEEE International Conference on Robotics and Automation, ICRA, pp. 2174–2181. IEEE (2015)
24.
go back to reference Zhang, J., Singh, S.: Low-drift and real-time lidar odometry and mapping. Auton. Robots 41(2), 401–416 (2017)CrossRef Zhang, J., Singh, S.: Low-drift and real-time lidar odometry and mapping. Auton. Robots 41(2), 401–416 (2017)CrossRef
Metadata
Title
MC2SLAM: Real-Time Inertial Lidar Odometry Using Two-Scan Motion Compensation
Authors
Frank Neuhaus
Tilman Koß
Robert Kohnen
Dietrich Paulus
Copyright Year
2019
DOI
https://doi.org/10.1007/978-3-030-12939-2_5

Premium Partner