Abstract
The generation of accurate terrain maps while navigating over off-road, irregular terrains is a complex challenge, due to the difficulties in the estimation of the pose of the laser rangefinders, which is required for the proper registration of the range measurements. This paper addresses this problem. The proposed methodology uses an Extended Kalman filter to estimate in real-time the instantaneous pose of the vehicle and the laser rangefinders by considering measurements acquired from an inertial measurement unit, internal sensorial data of the vehicle and the estimated heights of the four wheels, which are obtained from the terrain map and allow determination of the vehicle’s inclination. The estimated 6D pose of the laser rangefinders is used to correctly project the laser measurements onto the terrain map. The terrain map is a 2.5D map that stores in each cell the mean value and variance of the terrain height. In each map’s cell position, new laser observations are fused with existing height estimations using a Kalman filter. The proposed methodology is validated in the real world using an autonomous vehicle. Field trials show that the use of the proposed state estimation methodology produces maps with much higher accuracy than the standard approaches.
This is a preview of subscription content, log in via an institution to check access.
Similar content being viewed by others
References
Jazar, R.N.: Vehicle Dynamics: Theory and Application, p. 1015. Springer (2008)
Stavens, D., Thrun, S.: A self-supervised terrain roughness estimator for off-road autonomous driving. In: Proceedings of Conference on Uncertainty in AI, pp. 13–16 (2006)
Hadsell, R., Bagnell, J.A., Huber, D., Hebert, M.: Accurate rough terrain estimation with space-carving kernels. In: Proceedings of the 2009 Robotics: Science and Systems Conference - RSS 2009, Washington (2009)
Hebert, M., Caillas C., Krotkov, E., Kweon, I.S., Kanade, T.: Terrain mapping for a roving planetary explorer. In: Proceedings of International Conference on Robotics and Automation (ICRA), vol. 2, pp. 997–1002 (1989)
Pfaff, P., Triebel, R., Burgard, W.: An efficient extension to elevation maps for outdoor terrain mapping and loop closing. Int. J. Robot. Res. 26(2), 217–230 (2007)
Chen, T., Dai, B., Wang, R., Liu, D.: Gaussian-process-based ground segmentation for autonomous land vehicles. J. Intell. Robot. Syst. (In press)
Shin, Y., Jung, Ch., Chung, W.: Drivable road region detection using a single laser range finder for outdoor patrol robots. In: Proceedings of the 2010 IEEE Intelligent Vehicles Symposium, University of California, San Diego, pp. 21–24 (2010)
Ye, C., Borenstein, J.: A new terrain mapping method for mobile robots obstacle negotiation. In: Proceedings of the UGV Technology Conference at the 2002 SPIE AeroSense Symposium. pp. 21–25 (2003)
Gu, J., Cao, Q., Huang, Y.: Rapid traversability assessment in 2.5D grid-based map on rough terrain. Int. J. Adv. Rob. Syst. 5(4), 389–394 (2008)
Miller, I., Campbell, M.: A mixture-model based algorithm for real-time terrain estimation. J. Field Robot. 23(9), 755–775 (2006)
Qiu, Q., Yang, T., Han, J.: A new real-time algorithm for off-road terrain estimation using laser data. Sci. China Ser. F: Inf Sci. 52(9), 1658–1667 (2009)
Tse, R., Ahmed, N., Campbell, M.: Unified mixture-model based terrain estimation with Markov Random Fields. In: Proceedings of the 2012 IEEE International Conference On Multisensor Fusion and Integration for Intelligent Systems. Germany (2012)
Thrun, S., Montemerlo, M., Dahlkamp, H., Stavens, D., Aron, A., Diebel, J., Fong, P., Gale, J., Halpenny, M., Hoffmann, G., Lau, K., Oakley, C., Palatucci, M., Pratt, V., Stang, P., Strohband, S., Dupont, C., Jendrossek, L.-E., Koelen, C., Markey, C., Rummel, C., van Niekerk, J., Jensen, E., Alessandrini, P., Davies, B., Ettinger, S., Kaehler, A., Nefian, A., Mahoney, P.: Stanley: The robot that won the DARPA grand challenge. J. Field Robot. 23, 661–692 (2006)
Welch, G., Bishop, G.: An Introduction to the Kalman Filter. University of North Carolina at Chapel Hill, NC (1995)
Bernuy, F., Ruiz-del-Solar, J., Parra-Tsunekawa, I., Vallejos, P.A.: Adaptive and real-time unpaved road segmentation using color histograms and RANSAC. In: 9th IEEE International Conference on Control & Automation - ICCA 2011, pp. 136–141. Santiago (2011)
Cabello, F., Acuna, A., Vallejos, P.A., Orchard, M.E., Ruiz-del-Solar, J.: Design and validation of a fuzzy longitudinal controller based on a vehicle dynamic simulator. In: 9th IEEE International Conference on Control Automation - ICCA 2011, pp. 997–1002. Santiago (2011)
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
Cite this article
Parra-Tsunekawa, I., Ruiz-del-Solar, J. & Vallejos, P. A Kalman-filtering-based Approach for Improving Terrain Mapping in off-road Autonomous Vehicles. J Intell Robot Syst 78, 577–591 (2015). https://doi.org/10.1007/s10846-014-0087-9
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10846-014-0087-9