Hostname: page-component-669899f699-2mbcq Total loading time: 0 Render date: 2025-05-01T10:51:17.646Z Has data issue: false hasContentIssue false
  • English
  • Français

Autonomous vehicle self-localization in urban environments based on 3D curvature feature points – Monte Carlo localization

Published online by Cambridge University Press:  23 June 2021

Qi Liu Open the ORCID record for Qi Liu [Opens in a new window] ,
Xiaoguang Di Open the ORCID record for Xiaoguang Di [Opens in a new window]  and
Binfeng Xu
Qi Liu
Affiliation:
Control and Simulation Center, Harbin Institute of Technology, Harbin, China
Xiaoguang Di*
Affiliation:
Control and Simulation Center, Harbin Institute of Technology, Harbin, China
Binfeng Xu
Affiliation:
Department of Intelligent Driving, Horizon Robotics, Shanghai, China
*
*Corresponding author. Email: dixiaoguang@hit.edu.cn
Get access Rights & Permissions [Opens in a new window]

Abstract

This paper proposes a map-based localization system for autonomous vehicle self-localization in urban environments, which is composed of a pose graph mapping method and 3D curvature feature points – Monte Carlo Localization algorithm (3DCF-MCL). The advantage of 3DCF-MCL is that it combines the high accuracy of the 3D feature points registration and the robustness of particle filter. Experimental results show that 3DCF-MCL can provide an accurate localization for autonomous vehicles with the 3D point cloud map that generated by our mapping method. Compared with other map-based localization algorithms, it demonstrates that 3DCF-MCL outperforms them.

Keywords

Autonomous vehicle localizationPose graphInformation matrixFeature pointsParticle filter
Type
Article
Information
Robotica , Volume 40 , Issue 3 , March 2022 , pp. 817 - 833
Copyright
© The Author(s), 2021. Published by Cambridge University Press

Access options

Get access to the full version of this content by using one of the access options below. (Log in options will check for institutional or personal access. Content may require purchase if you do not have access.)

Article purchase

Temporarily unavailable

References

Heng, L., Walter, T., Enge, P. and Gao, G. X., “GNSS multipath and jamming mitigation using high-mask-angle antennas and multiple constellations,” IEEE Trans. Intell. Transp. Syst. 16(2), 741–750 (2015).Google Scholar
Kong, S.-H., “Statistical analysis of urban gps multipaths and pseudo-range measurement errors,” IEEE Trans. Aerospace Electr. Syst. 47(2), 1101–1113 (2011).CrossRefGoogle Scholar
Yurtsever, E., Lambert, J., Carballo, A. and Takeda, K., “A survey of autonomous driving: Common practices and emerging technologies,” IEEE Access 8, 58443–58469 (2020). doi: 10.1109/ACCESS.2020.2983149 CrossRefGoogle Scholar
Javanmardi, E., Gu, Y., Javanmardi, M. and Kamijo, S., “Autonomous vehicle self-localization based on abstract map and multi-channel lidar in urban area,” IATSS Res. 43(1), 1–13 (2019).CrossRefGoogle Scholar
Cadena, C., Carlone, L., Carrillo, H., Latif, Y., Scaramuzza, D., Neira, J., Reid, I. and Leonard, J. J., “Past, present, and future of simultaneous localization and mapping: Toward the robust-perception age,” IEEE Trans. Rob. 32(6), 1309–1332 (2016).CrossRefGoogle Scholar
Deschaud, J.-E., “IMLS-SLAM: Scan-to-Model Matching Based on 3D Data,” 2018 IEEE International Conference on Robotics and Automation (ICRA) (IEEE, 2018) pp. 2480–2485.CrossRefGoogle Scholar
Kato, S., Tokunaga, S., Maruyama, Y., Maeda, S., Hirabayashi, M., Kitsukawa, Y., Monrroy, A., Ando, T., Fujii, Y. and Azumi, T., “Autoware on Board: Enabling Autonomous Vehicles with Embedded Systems,” 2018 ACM/IEEE 9th International Conference on Cyber-Physical Systems (ICCPS) (IEEE, 2018) pp. 287–296.Google Scholar
Zhang, Y., Wang, L., Jiang, X., Zeng, Y. and Dai, Y., “An efficient lidar-based localization method for self-driving cars in dynamic environments,” Robotica, 1–18 (2021). doi: 10.1017/S0263574721000369 CrossRefGoogle Scholar
KÜmmerle, R., Grisetti, G., Strasdat, H., Konolige, K. and Burgard, W., “G2o: A General Framework for Graph Optimization,” 2011 IEEE International Conference on Robotics and Automation (IEEE, 2011) pp. 3607–3613.CrossRefGoogle Scholar
Koide, K., Miura, J. and Menegatti, E., “A portable 3d lidar-based system for long-term and wide-area people behavior measurement.” Int. J. Adv. Robot. Syst. 16(2), (2018).Google Scholar
Grisetti, G., Kummerle, R., Stachniss, C. and Burgard, W., “A tutorial on graph-based SLAM,” IEEE Intell. Transp. Syst. Mag. 2(4), 31–43 (2010).CrossRefGoogle Scholar
Besl, P. J. and McKay, N. D., “Method for Registration of 3-D Shapes,” In: Sensor Fusion IV: Control Paradigms and Data Structures, vol. 1611 (International Society for Optics and Photonics, 1992) pp. 586–607.Google Scholar
Segal, A., Haehnel, D. and Thrun, S., “Generalized-ICP,” In: Robotics: Science and Systems, vol. 2 (2009) p. 435.Google Scholar
Hong, S., Ko, H. and Kim, J., “VICP: Velocity Updating Iterative Closest Point Algorithm,” 2010 IEEE International Conference on Robotics and Automation (IEEE, 2010) pp. 1893–1898.CrossRefGoogle Scholar
Serafin, J. and Grisetti, G., “NICP: Dense Normal Based Point Cloud Registration,” 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE, 2015) pp. 742–749.CrossRefGoogle Scholar
ethz-asl. ethzasl_icp_mapping. https://github.com/ethz-asl/ethzasl_icp_mapping (2018).Google Scholar
P. Biber and W. Straßer, “The Normal Distributions Transform: A New Approach to Laser Scan Matching,” Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No. 03CH37453), vol. 3 (IEEE, 2003) pp. 2743–2748.Google Scholar
Magnusson, M., The Three-Dimensional Normal-Distributions Transform: An Efficient Representation for Registration, Surface Analysis, and Loop Detection Ph.D. Thesis (Örebro universitet, 2009).Google Scholar
Magnusson, M., Nuchter, A., Lorken, C., Lilienthal, A. J. and Hertzberg, J., “Evaluation of 3D Registration Reliability and Speed-a Comparison of ICP and NDT,” 2009 IEEE International Conference on Robotics and Automation (IEEE, 2009) pp. 3907–3912.CrossRefGoogle Scholar
Zhang, J. and Singh, S., “LOAN: Lidar Odometry and Mapping in Real-Time,” In: Robotics: Science and Systems, vol. 2 (2014) p. 9.Google Scholar
Moravec, H. and Elfes, A., “High Resolution Maps from Wide Angle Sonar,” Proceedings. 1985 IEEE International Conference on Robotics and Automation, vol. 2 (IEEE, 1985) pp. 116–121.Google Scholar
Wurm, K. M., Stachniss, C. and Grisetti, G., “Bridging the gap between feature-and grid-based SLAM,” Rob. Auto. Syst. 58(2), 140–148 (2010).CrossRefGoogle Scholar
Bailey, T., Mobile Robot Localisation and Mapping in Extensive Outdoor Environments (Citeseer, 2002).Google Scholar
Boal, J., Miralles, Á. S. and Arranz, A., “Topological simultaneous localization and mapping: A survey,” Robotica 32(5), 803–821 (2014).CrossRefGoogle Scholar
Hornung, A., Wurm, K. M., Bennewitz, M., Stachniss, C. and Burgard, W., “OctoMap: An efficient probabilistic 3d mapping framework based on octrees,” Auto. Robots 34(3), 189–206 (2013).CrossRefGoogle Scholar
Nelson, E., BLAM. https://github.com/erik-nelson/blam (2016).Google Scholar
DubÉ, R., Dugas, D., Stumm, E., Nieto, J., Siegwart, R. and Cadena, C., “Segmatch: Segment Based Place Recognition in 3D Point Clouds,” 2017 IEEE International Conference on Robotics and Automation (ICRA) (IEEE, 2017) pp. 5266–5272.CrossRefGoogle Scholar
Mendes, E., Koch, P. and Lacroix, S., “ICP-based Pose-Graph SLAM,” 2016 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR) (IEEE, 2016) pp. 195–200.CrossRefGoogle Scholar
Kaess, M., Johannsson, H., Roberts, R., Ila, V., Leonard, J. J. and Dellaert, F.. “ISAM2: Incremental smoothing and mapping using the bayes tree,” Int. J. Rob. Res., 31(2), 216–235 (2012).CrossRefGoogle Scholar
Karlsruhe Institute of Technology. kitti_odometry. http://www.cvlibs.net/datasets/kitti/eval_odometry.php (2020).Google Scholar
Dellaert, F., Fox, D., Burgard, W. and Thrun, S., “Monte Carlo Localization for Mobile Robots,” ICRA, vol. 2 (1999) pp. 1322–1328.Google Scholar
Chen, Y., Chen, W., Zhu, L., Su, Z., Zhou, X., Guan, Y. and Liu, G., “A study of sensor-fusion mechanism for mobile robot global localization,” Robotica 37(11), 1835–1849 (2019).CrossRefGoogle Scholar
Chen, D., Weng, J., Huang, F., Zhou, J., Mao, Y. and Liu, X., “Heuristic monte carlo algorithm for unmanned ground vehicles realtime localization and mapping,” IEEE Trans. Veh. Technol. 69(10), 10642–10655 (2020).CrossRefGoogle Scholar
Barfoot, T. D., State Estimation for Robotics (Cambridge University Press, Cambridge, UK, 2017).CrossRefGoogle Scholar
Hartley, R. and Zisserman, A., Multiple View Geometry in Computer Vision (Cambridge University Press, UK, 2003).Google Scholar
Thrun, S., Burgard, W. and Fox, D., Probabilistic Robotics (MIT Press, Cambridge, MA, 2005).Google Scholar
Vieira, F. C., Medeiros, A. A. D., Alsina, P. and AraÚjo, A. P., “Position and Orientation Control of a Two-Wheeled Differentially Driven Nonholonomic Mobile robot,” ICINCO (2004).Google Scholar
Berg, M., Kreveld, M., Overmars, M. and Schwarzkopf, O. C., Computational geometry: Algorithms and applications (Springer Berlin/Heidelberg, Berlin, Heidelberg, 2008).Google Scholar
Quigley, M., Conley, K., Gerkey, B., Faust, J., Foote, T., Leibs, J., Wheeler, R. and Ng, A. Y., “ROS: An Open-Source Robot Operating System,” ICRA Workshop on Open Source Software, vol. 3, Kobe, Japan (2009) p. 5.Google Scholar
Grupp, M., evo: Python package for the evaluation of odometry and SLAM. https://github.com/MichaelGrupp/evo (2017).Google Scholar