{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,6,27]],"date-time":"2026-06-27T15:38:52Z","timestamp":1782574732192,"version":"3.54.5"},"reference-count":46,"publisher":"MDPI AG","issue":"20","license":[{"start":{"date-parts":[[2019,10,10]],"date-time":"2019-10-10T00:00:00Z","timestamp":1570665600000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/501100001809","name":"National Natural Science Foundation of China","doi-asserted-by":"publisher","award":["61473042"],"award-info":[{"award-number":["61473042"]}],"id":[{"id":"10.13039\/501100001809","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100001809","name":"National Natural Science Foundation of China","doi-asserted-by":"publisher","award":["61105092"],"award-info":[{"award-number":["61105092"]}],"id":[{"id":"10.13039\/501100001809","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100001809","name":"National Natural Science Foundation of China","doi-asserted-by":"publisher","award":["61173076"],"award-info":[{"award-number":["61173076"]}],"id":[{"id":"10.13039\/501100001809","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100018621","name":"Program for Changjiang Scholars and Innovative Research Team in University","doi-asserted-by":"publisher","award":["IRT-16R06"],"award-info":[{"award-number":["IRT-16R06"]}],"id":[{"id":"10.13039\/501100018621","id-type":"DOI","asserted-by":"publisher"}]},{"DOI":"10.13039\/501100018621","name":"Program for Changjiang Scholars and Innovative Research Team in University","doi-asserted-by":"publisher","award":["T2014224"],"award-info":[{"award-number":["T2014224"]}],"id":[{"id":"10.13039\/501100018621","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>This paper presents a traversability assessment method and a trajectory planning method. They are key features for the navigation of an unmanned ground vehicle (UGV) in a non-planar environment. In this work, a 3D light detection and ranging (LiDAR) sensor is used to obtain the geometric information about a rough terrain surface. For a given SE(2) pose of the vehicle and a specific vehicle model, the SE(3) pose of the vehicle is estimated based on LiDAR points, and then a traversability is computed. The traversability tells the vehicle the effects of its interaction with the rough terrain. Note that the traversability is computed on demand during trajectory planning, so there is not any explicit terrain discretization. The proposed trajectory planner finds an initial path through the non-holonomic A*, which is a modified form of the conventional A* planner. A path is a sequence of poses without timestamps. Then, the initial path is optimized in terms of the traversability, using the method of Lagrange multipliers. The optimization accounts for the model of the vehicle\u2019s suspension system. Therefore, the optimized trajectory is dynamically feasible, and the trajectory tracking error is small. The proposed methods were tested in both the simulation and the real-world experiments. The simulation experiments were conducted in a simulator called Gazebo, which uses a physics engine to compute the vehicle motion. The experiments were conducted in various non-planar experiments. The results indicate that the proposed methods could accurately estimate the SE(3) pose of the vehicle. Besides, the trajectory cost of the proposed planner was lower than the trajectory costs of other state-of-the-art trajectory planners.<\/jats:p>","DOI":"10.3390\/s19204372","type":"journal-article","created":{"date-parts":[[2019,10,11]],"date-time":"2019-10-11T03:07:11Z","timestamp":1570763231000},"page":"4372","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":34,"title":["Traversability Assessment and Trajectory Planning of Unmanned Ground Vehicles with Suspension Systems on Rough Terrain"],"prefix":"10.3390","volume":"19","author":[{"ORCID":"https:\/\/orcid.org\/0000-0002-0002-2184","authenticated-orcid":false,"given":"Kai","family":"Zhang","sequence":"first","affiliation":[{"name":"School of Automation, Beijing Institute of Technology, Beijing 100081, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Yi","family":"Yang","sequence":"additional","affiliation":[{"name":"School of Automation, Beijing Institute of Technology, Beijing 100081, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Mengyin","family":"Fu","sequence":"additional","affiliation":[{"name":"School of Automation, Beijing Institute of Technology, Beijing 100081, China"},{"name":"School of Automation, Nanjing University of Science and Technology, Nanjing 210094, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Meiling","family":"Wang","sequence":"additional","affiliation":[{"name":"School of Automation, Beijing Institute of Technology, Beijing 100081, China"}],"role":[{"vocabulary":"crossref","role":"author"}]}],"member":"1968","published-online":{"date-parts":[[2019,10,10]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"163","DOI":"10.1023\/A:1008822205706","article-title":"Rough terrain autonomous mobility\u2014Part 2: An active vision, predictive control approach","volume":"5","author":"Kelly","year":"1998","journal-title":"Auton. Robots"},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"917","DOI":"10.1177\/0278364902021010841","article-title":"Autonomous rover navigation on unknown terrains: Functions and integration","volume":"21","author":"Lacroix","year":"2002","journal-title":"Int. J. Robot. Res."},{"key":"ref_3","doi-asserted-by":"crossref","unstructured":"Bai, C., and Guo, J. (2019). Uncertainty-Based Vibration\/Gyro Composite Planetary Terrain Mapping. Sensors, 19.","DOI":"10.3390\/s19122681"},{"key":"ref_4","doi-asserted-by":"crossref","unstructured":"Zhou, X., Bai, T., Gao, Y., and Han, Y. (2019). Vision-Based Robot Navigation through Combining Unsupervised Learning and Hierarchical Reinforcement Learning. Sensors, 19.","DOI":"10.3390\/s19071576"},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Wellington, C., Courville, A.C., and Stentz, A. (2005, January 8\u201311). Interacting Markov Random Fields for Simultaneous Terrain Modeling and Obstacle Detection. Proceedings of the Robotics: Science and Systems, Cambridge, MA, USA.","DOI":"10.15607\/RSS.2005.I.001"},{"key":"ref_6","unstructured":"Daily, M., Harris, J., Keirsey, D., Olin, D., Payton, D., Reiser, K., Rosenblatt, J., Tseng, D., and Wong, V. (1988, January 24\u201329). Autonomous cross-country navigation with the ALV. Proceedings of the 1988 IEEE International Conference on Robotics and Automation, Philadelphia, PA, USA."},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Ye, C., and Borenstein, J. (2003, January 30). A new terrain mapping method for mobile robots obstacle negotiation. Proceedings of the Unmanned Ground Vehicle Technology, Orlando, FL, USA.","DOI":"10.1117\/12.486764"},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Ren, Z., Wang, L., and Bi, L. (2019). Robust GICP-Based 3D LiDAR SLAM for Underground Mining Environment. Sensors, 19.","DOI":"10.3390\/s19132915"},{"key":"ref_9","doi-asserted-by":"crossref","unstructured":"Peterson, J., Chaudhry, H., Abdelatty, K., Bird, J., and Kochersberger, K. (2018). Online Aerial Terrain Mapping for Ground Robot Navigation. Sensors, 18.","DOI":"10.3390\/s18020630"},{"key":"ref_10","doi-asserted-by":"crossref","unstructured":"Vlaminck, M., Luong, H., and Philips, W. (2019). Have I Seen This Place Before? A Fast and Robust Loop Detection and Correction Method for 3D Lidar SLAM. Sensors, 19.","DOI":"10.3390\/s19010023"},{"key":"ref_11","doi-asserted-by":"crossref","unstructured":"Pang, C., Zhong, X., Hu, H., Tian, J., Peng, X., and Zeng, J. (2018). Adaptive Obstacle Detection for Mobile Robots in Urban Environments Using Downward-Looking 2D LiDAR. Sensors, 18.","DOI":"10.3390\/s18061749"},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Casta\u00f1o, F., Beruvides, G., Haber, R.E., and Artu\u00f1edo, A. (2017). Obstacle Recognition Based on Machine Learning for On-Chip LiDAR Sensors in a Cyber-Physical System. Sensors, 17.","DOI":"10.20944\/preprints201708.0014.v1"},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Casta\u00f1o, F., Beruvides, G., Villalonga, A., and Haber, R.E. (2018). Self-Tuning Method for Increased Obstacle Detection Reliability Based on Internet of Things LiDAR Sensor Models. Sensors, 18.","DOI":"10.20944\/preprints201802.0192.v1"},{"key":"ref_14","unstructured":"Maimone, M., Johnson, A., Cheng, Y., Willson, R., and Matthies, L. (2004, January 18\u201321). Autonomous Navigation Results from the Mars Exploration Rover (MER) Mission. Proceedings of the 9th International Symposium on Experimental Robotics, Singapore."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Wettergreen, D., Jonak, D., Kohanbash, D., Moreland, S., Spiker, S., and Teza, J. (2009, January 13). Field Experiments in Mobility and Navigation with a Lunar Rover Prototype. Proceedings of the 7th International Conference on Field and Service Robotics, Cambridge, MA, USA.","DOI":"10.1007\/978-3-642-13408-1_44"},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"217","DOI":"10.1177\/0278364906075165","article-title":"An efficient extension to elevation maps for outdoor terrain mapping and loop closing","volume":"26","author":"Pfaff","year":"2007","journal-title":"Int. J. Robot. Res."},{"key":"ref_17","doi-asserted-by":"crossref","first-page":"1465","DOI":"10.1177\/0278364912461537","article-title":"Tensor-voting-based navigation for robotic inspection of 3D surfaces using lidar point clouds","volume":"31","author":"Stumm","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"106","DOI":"10.1016\/j.robot.2012.10.012","article-title":"Application of the fast marching method for outdoor motion planning in robotics","volume":"61","author":"Garrido","year":"2013","journal-title":"Robot. Auton. Syst."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Kummerle, R., Hahnel, D., Dolgov, D., Thrun, S., and Burgard, W. (2009, January 12\u201317). Autonomous driving in a multi-level parking structure. Proceedings of the 2009 IEEE International Conference on Robotics and Automation, Kobe, Japan.","DOI":"10.1109\/ROBOT.2009.5152365"},{"key":"ref_20","doi-asserted-by":"crossref","unstructured":"Khan, Y.N., Komma, P., and Zell, A. (2011, January 6\u201313). High resolution visual terrain classification for outdoor robots. Proceedings of the 2011 IEEE International Conference on Computer Vision Workshops, Barcelona, Spain.","DOI":"10.1109\/ICCVW.2011.6130362"},{"key":"ref_21","unstructured":"Singh, S., Simmons, R., Smith, T., Stentz, A., Verma, V., Yahja, A., and Schwehr, K. (2000, January 24\u201328). Recent progress in local and global traversability for planetary rovers. Proceedings of the 2000 IEEE International Conference on Robotics and Automation, San Francisco, CA, USA."},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"241","DOI":"10.1002\/rob.20376","article-title":"Stereo-based all-terrain obstacle detection using visual saliency","volume":"28","author":"Santana","year":"2011","journal-title":"J. Field Robot."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"997","DOI":"10.1177\/0278364910370241","article-title":"Non-parametric learning to aid path planning over slopes","volume":"29","author":"Karumanchi","year":"2010","journal-title":"Int. J. Robot. Res."},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"969","DOI":"10.1002\/rob.21536","article-title":"Learned stochastic mobility prediction for planning with control uncertainty on unstructured terrain","volume":"31","author":"Peynot","year":"2014","journal-title":"J. Field Robot."},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"158","DOI":"10.1002\/rob.20332","article-title":"Adaptive rover behavior based on online empirical evaluation: Rover\u2013terrain interaction and near-to-far learning","volume":"27","author":"Krebs","year":"2010","journal-title":"J. Field Robot."},{"key":"ref_26","doi-asserted-by":"crossref","first-page":"940","DOI":"10.1002\/rob.21700","article-title":"Driving on point clouds: Motion planning, trajectory optimization, and terrain assessment in generic nonplanar environments","volume":"34","author":"Furgale","year":"2017","journal-title":"J. Field Robot."},{"key":"ref_27","doi-asserted-by":"crossref","first-page":"42","DOI":"10.1002\/rob.21521","article-title":"Terrain Classification in Complex Three-dimensional Outdoor Environments","volume":"32","author":"Teniente","year":"2015","journal-title":"J. Field Robot."},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"171","DOI":"10.1016\/j.robot.2017.10.011","article-title":"A survey of robotic motion planning in dynamic environments","volume":"100","author":"Mohanan","year":"2018","journal-title":"Robot. Auton. Syst."},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"1255","DOI":"10.1109\/TITS.2016.2604240","article-title":"A Potential Field-Based Model Predictive Path-Planning Controller for Autonomous Road Vehicles","volume":"18","author":"Rasekhipour","year":"2017","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"33","DOI":"10.1109\/TIV.2016.2578706","article-title":"A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles","volume":"1","author":"Paden","year":"2016","journal-title":"IEEE Trans. Intell. Veh."},{"key":"ref_31","doi-asserted-by":"crossref","first-page":"1011","DOI":"10.1080\/02331934.2013.836650","article-title":"A new, globally convergent Riemannian conjugate gradient method","volume":"64","author":"Sato","year":"2015","journal-title":"Optimization"},{"key":"ref_32","doi-asserted-by":"crossref","first-page":"100","DOI":"10.1109\/TSSC.1968.300136","article-title":"A Formal Basis for the Heuristic Determination of Minimum Cost Paths","volume":"4","author":"Hart","year":"1968","journal-title":"IEEE Trans. Syst. Sci. Cybern."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"308","DOI":"10.1002\/rob.20285","article-title":"Differentially constrained mobile robot motion planning in state lattices","volume":"26","author":"Pivtoraiko","year":"2009","journal-title":"J. Field Robot."},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"378","DOI":"10.1177\/02783640122067453","article-title":"Randomized Kinodynamic Planning","volume":"20","author":"LaValle","year":"2001","journal-title":"Int. J. Robot. Res."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"846","DOI":"10.1177\/0278364911406761","article-title":"Sampling-based algorithms for optimal motion planning","volume":"30","author":"Karaman","year":"2011","journal-title":"Int. J. Robot. Res."},{"key":"ref_36","unstructured":"Amar, F.B., Bidaud, P., and Ouezdou, F.B. (1993, January 26\u201330). On modeling and motion planning of planetary vehicles. Proceedings of the 1993 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Yokohama, Japan."},{"key":"ref_37","doi-asserted-by":"crossref","first-page":"141","DOI":"10.1177\/0278364906075328","article-title":"Optimal rough terrain trajectory generation for wheeled mobile robots","volume":"26","author":"Howard","year":"2007","journal-title":"Int. J. Robot. Res."},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"534","DOI":"10.1002\/rob.20342","article-title":"Visual teach and repeat for long-range rover autonomy","volume":"27","author":"Furgale","year":"2010","journal-title":"J. Field Robot."},{"key":"ref_39","doi-asserted-by":"crossref","first-page":"254","DOI":"10.1002\/rob.21444","article-title":"Lighting-invariant visual teach and repeat using appearance-based lidar","volume":"30","author":"McManus","year":"2013","journal-title":"J. Field Robot."},{"key":"ref_40","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1007\/s10514-012-9309-9","article-title":"Autonomous over-the-horizon navigation using LIDAR data","volume":"34","author":"Rekleitis","year":"2013","journal-title":"Auton. Robots"},{"key":"ref_41","doi-asserted-by":"crossref","first-page":"940","DOI":"10.1002\/rob.21528","article-title":"Seeker\u2014Autonomous Long-range Rover Navigation for Remote Exploration","volume":"31","author":"Woods","year":"2014","journal-title":"J. Field Robot."},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"1565","DOI":"10.1177\/0278364910369715","article-title":"Learning from Demonstration for Autonomous Navigation in Complex Unstructured Terrain","volume":"29","author":"Silver","year":"2010","journal-title":"Int. J. Robot. Res."},{"key":"ref_43","doi-asserted-by":"crossref","first-page":"2","DOI":"10.1016\/j.procs.2017.09.070","article-title":"Performance Analysis of Half Car Suspension Model with 4 DOF using PID, LQR, FUZZY and ANFIS Controllers","volume":"115","author":"Gandhi","year":"2017","journal-title":"Procedia Comput. Sci."},{"key":"ref_44","doi-asserted-by":"crossref","unstructured":"Ikenaga, S., Lewis, F.L., Campos, J., and Davis, L. (2000, January 28\u201330). Active suspension control of ground vehicle based on a full-vehicle model. Proceedings of the 2000 American Control Conference, Chicago, IL, USA.","DOI":"10.1109\/ACC.2000.876977"},{"key":"ref_45","doi-asserted-by":"crossref","unstructured":"Ho, K., Peynot, T., and Sukkarieh, S. (2013, January 6\u201310). Traversability estimation for a planetary rover via experimental kernel learning in a Gaussian process framework. Proceedings of the 2013 IEEE International Conference on Robotics and Automation, Karlsruhe, Germany.","DOI":"10.1109\/ICRA.2013.6631063"},{"key":"ref_46","doi-asserted-by":"crossref","first-page":"653","DOI":"10.1007\/s12239-015-0067-5","article-title":"Real-time path planning of autonomous vehicles for unstructured road navigation","volume":"16","author":"Chu","year":"2015","journal-title":"Int. J. Automot. Technol."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/19\/20\/4372\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T13:28:57Z","timestamp":1760189337000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/19\/20\/4372"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2019,10,10]]},"references-count":46,"journal-issue":{"issue":"20","published-online":{"date-parts":[[2019,10]]}},"alternative-id":["s19204372"],"URL":"https:\/\/doi.org\/10.3390\/s19204372","relation":{},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2019,10,10]]}}}