Terrain Recognition and Path Planning for Quadruped Robot
ZHANG Hui1, RONG Xuewen1, LI Yibin1, LI Bin1, DING Chao1, ZHANG Junwen1, ZHANG Qin2
1. School of Control Science and Engineering, Shandong University, Jinan 250061, China;
2. School of Electrical Engineering, Jinan University, Jinan 250022, China
In order to improve the adaptability of the quadruped robot in complex environments, the environment perception strategy based on time of flight (TOF) camera is investigated, and the terrain recognition and path planning algorithms are improved.Firstly, the Gaussian process regression (GPR) model is used to calibrate the range error of the TOF camera, and with this model, the high-order computation and complex function composition caused by polynomial or trigonometric function models are avoided.Based on the depth information of the environment, the terrain is represented with the digital elevation model (DEM) and recognized by the slope, roughness and step height of the grid.The roughness is obtained through the dispersion between the slope plane in which the grid locates and its 8-neighbor height points, which avoids the detection error when using the variance of the terrain height.Based on the terrain information, a path planning algorithm using sliding window and incremental A* (IA*) is proposed.When IA* is used in route planning, the optimal route from the current route to the new goal projection is searched out incrementally.Compared with A*, the IA* algorithm enables the robot to replan a path more efficiently.The simulation and experiment results illustrate the feasibility and effectiveness of the proposed algorithms.
[1] Wooden D, Malchano M, Blankespoor K, et al.Autonomous navigation for BigDog[C]//IEEE International Conference on Robotics and Automation.Piscataway, USA: IEEE, 2010: 4736-4741.[2] Bajracharya M, Ma J, Malchano M, et al.High fidelity day/night stereo mapping with vegetation and negative obstacle detection for vision-in-the-loop walking[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems.Piscataway,USA: IEEE, 2013: 3663-3670.[3] Ma J, Susca S, Bajracharya M, et al.Robust multi-sensor, day/night 6-DOF pose estimation for a dynamic legged vehicle in GPS-denied environments[C]//IEEE International Conference on Robotics and Automation.Piscataway, USA: IEEE, 2012: 619-626.[4] Winkler A, Havoutis I, Bazeille S, et al.Path planning with force-based foothold adaptation and virtual model control for torque controlled quadruped robots[C]//IEEE International Conference on Robotics and Automation.Piscataway, USA: IEEE, 2014: 6476-6482.[5] Arain M A, Havoutis I, Semini C, et al.A comparison of search-based planners for a legged robot[C]//Proceedings of the 9th International Workshop on Robot Motion and Control.Piscataway, USA: IEEE, 2013: 104-109.[6] Bazeille S, Barasuol V, Focchi M, et al.Quadruped robot trotting over irregular terrain assisted by stereo-vision[J].Intelligent Service Robotics, 2014, 7(2): 67-77. [7] Chilian A, Hirschmuller H.Stereo camera based navigation of mobile robots on rough terrain[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems.Piscataway,USA: IEEE, 2009: 4571-4576.[8] Kahlmann T, Remondino H, Ingensand H.Calibration for increased accuracy of the range imaging camera SwissRangerm TM [C]//ISPRS Commission V Symposium 'Image Engineering and Vision Metrology'.2006: 136-141.[9] Pattinson T.Quantification and description of distance measurement errors of a time-of-flight camera[D].Stuttgart, Germany: University of Stuttgart, 2010.[10] Jamtsho S.Geometric modelling of 3D range cameras and their application for structural deformation measurement[R].Alberta, Canada: University of Calgary, 2010.[11] Kim Y M, Chan D, Theobalt C, et al.Design and calibration of a multi-view TOF sensor fusion system[C]//IEEE Computer Society Conference on Computer Vision and Pattern Recognition Workshops.Piscataway, USA: IEEE, 2008: 1524-1530.[12] Rasmussen C E, Williams C K I.Gaussian processes for machine learning[M].Cambridge, USA: MIT Press, 2006.[13] 何志昆,刘光斌,赵曦晶,等.高斯过程回归方法综述[J].控制与决策,2013,28(8):1121-1129.He Z K, Liu G B, Zhao X J, et al.Overview of Gaussian process regression[J].Control and Decision, 2013, 28(8): 1121-1129.[14] Souza J R, Marchant R, Ott L, et al.Bayesian optimisation for active perception and smooth navigation[C]//IEEE International Conference on Robotics and Automation.Piscataway, USA: IEEE, 2014: 4081-4087.[15] Pfaff P, Burgard W.An efficient extension of elevation maps for outdoor terrain mapping[C]//5th International Conference on Field and Service Robotics.Berlin, Germany: Springer, 2006: 195-206.[16] 陈艳丽,李少梅,刘岱岳.基于规则格网DEM的坡度坡向分析研究[J].测绘与空间地理信息,2009,32(5):36-39.Chen Y L, Li S M, Liu D Y.Analysis of slope and aspect based on regular grid DEM[J].Geomatics & Spatial Information Technology, 2009, 32(5): 36-39.[17] Hart P E, Nilsson N J, Raphael B.A formal basis for heuristic determination of minimum cost paths[J].IEEE Transactions on Systems Science and Cybernetics, 1968, 4(2): 100-107. [18] Likhachev M, Ferguson D, Gordon G, et al.Anytime search in dynamic graphs[J].Artificial Intelligence, 2008, 172(14): 1613-1643. [19] Koenig S, Likhachev M, Furcy D.Lifelong planning A*[J].Artificial Intelligence, 2004, 155(1-2): 93-146. [20] Stentz A.The focussed D* algorithm for real-time replanning[C]//Proceedings of the International Joint Conference on Artificial Intelligence.San Mateo, USA: Morgan Kaufmann Publishers, 1995: 1652-1659.[21] Koenig S, Likhachev M.Fast replanning for navigation in unknown terrain[J].IEEE Transactions on Robotics, 2005, 21(3): 354-363. [22] 柴汇,孟健,荣学文,等.高性能液压驱动四足机器人SCalf的设计与实现[J].机器人,2014,36(4):385-391.ewline Chai H, Meng J, Rong X W, et al.Design and implementation of SCarf, an advanced hydraulic quadruped robot[J].Robot, 2014, 36(4): 385-391.[23] 孟健,李贻斌,李彬.四足机器人对角小跑步态全方位移动控制方法及其实现[J].机器人,2015,37(1):74-84.ewline Meng J, Li Y B, Li B.Control method and its implementation of quadruped robot in omni-directional trotting gait[J].Robot, 2015, 37(1): 74-84.