{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,12,26]],"date-time":"2025-12-26T07:13:45Z","timestamp":1766733225631,"version":"build-2065373602"},"reference-count":38,"publisher":"MDPI AG","issue":"13","license":[{"start":{"date-parts":[[2021,6,27]],"date-time":"2021-06-27T00:00:00Z","timestamp":1624752000000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Sensors"],"abstract":"<jats:p>This paper proposes an optimized trajectory planner and motion planner framework, which aim to deal with obstacle avoidance along a reference road for autonomous driving in unstructured environments. The trajectory planning problem is decomposed into lateral and longitudinal planning sub-tasks along the reference road. First, a vehicle kinematic model with road coordinates is established to describe the lateral movement of the vehicle. Then, nonlinear optimization based on a vehicle kinematic model in the space domain is employed to smooth the reference road. Second, a multilayered search algorithm is applied in the lateral-space domain to deal with obstacles and find a suitable path boundary. Then, the optimized path planner calculates the optimal path by considering the distance to the reference road and the curvature constraints. Furthermore, the optimized speed planner takes into account the speed boundary in the space domain and the constraints on vehicle acceleration. The optimal speed profile is obtained by using a numerical optimization method. Furthermore, a motion controller based on a kinematic error model is proposed to follow the desired trajectory. Finally, the experimental results show the effectiveness of the proposed trajectory planner and motion controller framework in handling typical scenarios and avoiding obstacles safely and smoothly on the reference road and in unstructured environments.<\/jats:p>","DOI":"10.3390\/s21134409","type":"journal-article","created":{"date-parts":[[2021,6,27]],"date-time":"2021-06-27T23:57:22Z","timestamp":1624838242000},"page":"4409","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":24,"title":["An Optimized Trajectory Planner and Motion Controller Framework for Autonomous Driving in Unstructured Environments"],"prefix":"10.3390","volume":"21","author":[{"given":"Lu","family":"Xiong","sequence":"first","affiliation":[{"name":"School of Automotive Studies, Tongji University, Shanghai 201804, China"},{"name":"Clean Energy Automotive Engineering Centre, Tongji University, Shanghai 201804, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-2707-3774","authenticated-orcid":false,"given":"Zhiqiang","family":"Fu","sequence":"additional","affiliation":[{"name":"School of Automotive Studies, Tongji University, Shanghai 201804, China"},{"name":"Clean Energy Automotive Engineering Centre, Tongji University, Shanghai 201804, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Dequan","family":"Zeng","sequence":"additional","affiliation":[{"name":"School of Automotive Studies, Tongji University, Shanghai 201804, China"},{"name":"Clean Energy Automotive Engineering Centre, Tongji University, Shanghai 201804, China"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Bo","family":"Leng","sequence":"additional","affiliation":[{"name":"School of Automotive Studies, Tongji University, Shanghai 201804, China"},{"name":"Clean Energy Automotive Engineering Centre, Tongji University, Shanghai 201804, China"}],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"1968","published-online":{"date-parts":[[2021,6,27]]},"reference":[{"key":"ref_1","first-page":"1","article-title":"A review of motion planning techniques for automated vehicles","volume":"17","author":"Gonzalez","year":"2015","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"1028","DOI":"10.1080\/00423114.2019.1610182","article-title":"Trends in vehicle motion control for automated driving on public roads","volume":"57","author":"Klomp","year":"2019","journal-title":"Veh. Syst. Dyn."},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"939","DOI":"10.1002\/rob.20265","article-title":"Motion planning in urban environments","volume":"25","author":"Ferguson","year":"2008","journal-title":"J. Field Robot."},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"1961","DOI":"10.1109\/TITS.2015.2389215","article-title":"Efficient Sampling-Based Motion Planning for On-Road Autonomous Driving","volume":"16","author":"Ma","year":"2015","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"346","DOI":"10.1177\/0278364911423042","article-title":"Optimal trajectories for time-critical street scenarios using discretized terminal manifolds","volume":"31","author":"Werling","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"1105","DOI":"10.1109\/TCST.2008.2012116","article-title":"Real-time motion planning with applications to autonomous urban driving","volume":"17","author":"Kuwata","year":"2009","journal-title":"IEEE Trans. Control Syst. Technol."},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"384","DOI":"10.1109\/TRO.2006.870668","article-title":"Modified Newton\u2019s method applied to potential field-based navigation for mobile robots","volume":"22","author":"Ren","year":"2006","journal-title":"IEEE Trans. Robot."},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"14533","DOI":"10.1016\/j.ifacol.2017.08.2076","article-title":"Path planning with fractional potential fields for autonomous vehicles","volume":"50","author":"Moreau","year":"2017","journal-title":"IFAC-Pap. OnLine"},{"key":"ref_9","unstructured":"Likhachev, M., Gordon, G.J., and Thrun, S. (2003, January 8\u201313). ARA*: Anytime A* with Provable Bounds on Sub-Optimality. Proceedings of the Advances in Neural Information Processing Systems 16, Vancouver and Whistler, BC, Canada."},{"key":"ref_10","first-page":"18","article-title":"Practical Search Techniques in Path Planning for Autonomous Driving","volume":"1001","author":"Dolgov","year":"2008","journal-title":"Ann Arbor"},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"485","DOI":"10.1177\/0278364909359210","article-title":"Path Planning for Autonomous Vehicles in Unknown Semi-structured Environments","volume":"29","author":"Dolgov","year":"2010","journal-title":"Int. J. Robot. Res."},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Samaniego, R., Lopez, J., and Vazquez, F. (2017). Path Planning for Non-Circular, Non-Holonomic Robots in Highly Cluttered Environments. Sensors, 17.","DOI":"10.3390\/s17081876"},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Kuwata, Y., Fiore, G.A., Teo, J., Frazzoli, E., and How, J.P. (2008, January 22\u201326). Motion planning for urban driving using RRT. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots & Systems, Nice, France.","DOI":"10.1109\/IROS.2008.4651075"},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"3313","DOI":"10.1109\/TITS.2018.2873921","article-title":"Crash mitigation in motion planning for autonomous vehicles","volume":"20","author":"Wang","year":"2019","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Cao, M., Wang, R., Wang, J., and Chen, N. (2018, January 4\u20137). An integrated MPC approach for FWIA autonomous ground vehicles with emergency collision avoidance. Proceedings of the 2018 21st International Conference on Intelligent Transportation Systems (ITSC), Maui, HI, USA.","DOI":"10.1109\/ITSC.2018.8569445"},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"204","DOI":"10.1109\/TIV.2019.2955854","article-title":"Autonomous Vehicles Turning Motion Planning in Multi-Interaction Area of Mixed-Flow Intersections","volume":"5","author":"Zhou","year":"2019","journal-title":"IEEE Trans. Intell. Veh."},{"key":"ref_17","doi-asserted-by":"crossref","unstructured":"Noguchi, Y., and Maki, T. (2019, January 16\u201319). Path planning method based on artificial potential field and reinforcement learning for intervention AUVs. Proceedings of the 2019 IEEE Underwater Technology (UT), Kaohsiung, Taiwan.","DOI":"10.1109\/UT.2019.8734314"},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"1166","DOI":"10.1049\/el.2018.5018","article-title":"Artificial potential field algorithm for path control of unmanned ground vehicles formation in highway","volume":"54","author":"Wang","year":"2018","journal-title":"Electron. Lett."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Li, X., Tang, B., Ball, J., Doude, M., and Carruth, D.W. (2019). Rollover-Free Path Planning for Off-Road Autonomous Driving. Electronics, 8.","DOI":"10.3390\/electronics8060614"},{"key":"ref_20","doi-asserted-by":"crossref","first-page":"1599","DOI":"10.1109\/TITS.2012.2198214","article-title":"Local Path Planning for Off-Road Autonomous Driving With Avoidance of Static Obstacles","volume":"13","author":"Chu","year":"2012","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Li, X., Sun, Z., Liu, D., Zhu, Q., and Huang, Z. (2014, January 8\u201311). Combining local trajectory planning and tracking control for autonomous ground vehicles navigating along a reference path. Proceedings of the 17th International IEEE Conference on Intelligent Transportation Systems (ITSC), Qingdao, China.","DOI":"10.1109\/ITSC.2014.6957775"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"32800","DOI":"10.1109\/ACCESS.2018.2845448","article-title":"Hybrid Trajectory Planning for Autonomous Driving in Highly Constrained Environments","volume":"6","author":"Zhang","year":"2018","journal-title":"IEEE Access"},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Netto, M., Blosseville, J.M., Lusetti, B., and Mammar, S. (2006, January 17\u201320). A new robust control system with optimized use of the lane detection data for vehicle full lateral control under strong curvatures. Proceedings of the 2006 IEEE Intelligent Transportation Systems Conference, Toronto, ON, Canada.","DOI":"10.1109\/ITSC.2006.1707416"},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"109120","DOI":"10.1109\/ACCESS.2019.2933895","article-title":"Optimal Path Tracking Control of Autonomous Vehicle: Adaptive Full-State Linear Quadratic Gaussian (LQG) Control","volume":"7","author":"Lee","year":"2019","journal-title":"IEEE Access"},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"661","DOI":"10.1002\/rob.20147","article-title":"Stanley: The robot that won the DARPA Grand Challenge","volume":"23","author":"Thrun","year":"2006","journal-title":"J. Field Robot."},{"key":"ref_26","first-page":"504","article-title":"Integrated mobile robot control","volume":"91","author":"Amidi","year":"1991","journal-title":"Proc. SPIE Int. Soc. Opt. Eng."},{"key":"ref_27","unstructured":"Kelly, A., and Stentz, A. (February, January 29). An approach to rough terrain autonomous mobility. Proceedings of the International Conference on Mobile Planetary Robots, Santa Monica, CA, USA."},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Jin, H., Liu, L., Lan, W., and Zeng, J. (2017, January 26\u201328). On stability and robustness of linear active disturbance rejection control: A small gain theorem approach. Proceedings of the 2017 36th Chinese Control Conference (CCC), Dalian, China.","DOI":"10.23919\/ChiCC.2017.8027857"},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"95","DOI":"10.3969\/j.issn.1004-4132.2011.01.012","article-title":"Active disturbance rejection control on first-order plant","volume":"22","author":"Yang","year":"2011","journal-title":"J. Syst. Eng. Electron."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"106","DOI":"10.1049\/iet-cta.2018.5941","article-title":"Personalised lane keeping assist strategy: Adaptation to driving style","volume":"13","author":"Rath","year":"2018","journal-title":"IET Control Theory Appl."},{"key":"ref_31","doi-asserted-by":"crossref","first-page":"1103","DOI":"10.1109\/TMECH.2018.2816963","article-title":"Collision-free navigation of autonomous vehicles using convex quadratic programming-based model predictive control","volume":"23","author":"Wang","year":"2018","journal-title":"IEEE\/ASME Trans. Mechatron."},{"key":"ref_32","doi-asserted-by":"crossref","first-page":"2850","DOI":"10.1007\/s12555-019-9091-y","article-title":"Obstacle Avoidance Path Planning based on Output Constrained Model Predictive Control","volume":"17","author":"Kim","year":"2019","journal-title":"Int. J. Control Autom. Syst."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"566","DOI":"10.1109\/TCST.2007.894653","article-title":"Predictive Active Steering Control for Autonomous Vehicle Systems","volume":"15","author":"Falcone","year":"2007","journal-title":"IEEE Trans. Control Syst. Technol."},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"611","DOI":"10.1080\/00423110802018297","article-title":"MPC-based yaw and lateral stabilisation via active front steering and braking","volume":"46","author":"Falcone","year":"2008","journal-title":"Veh. Syst. Dyn."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"6970","DOI":"10.1109\/TIE.2016.2585079","article-title":"Development of a Genetic-Algorithm-Based Nonlinear Model Predictive Control Scheme on Velocity and Steering of Autonomous Vehicles","volume":"63","author":"Du","year":"2016","journal-title":"IEEE Trans. Ind. Electron."},{"key":"ref_36","doi-asserted-by":"crossref","unstructured":"Katriniok, A., and Abel, D. (2011, January 12\u201315). LTV-MPC approach for lateral vehicle guidance by front steering at the limits of vehicle dynamics. Proceedings of the 50th IEEE Conference on Decision and Control and European Control Conference (CDC-ECC), Orlando, FL, USA.","DOI":"10.1109\/CDC.2011.6161257"},{"key":"ref_37","doi-asserted-by":"crossref","unstructured":"Sun, Q., Guo, Y., Fu, R., Wang, C., and Yuan, W. (2020). Human-Like Obstacle Avoidance Trajectory Planning and Tracking Model for Autonomous Vehicles That Considers the River\u2019s Operation Characteristics. Sensors, 20.","DOI":"10.3390\/s20174821"},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"8746","DOI":"10.1109\/TVT.2017.2707076","article-title":"Combined Speed and Steering Control in High Speed Autonomous Ground Vehicles for Obstacle Avoidance Using Model Predictive Control","volume":"66","author":"Liu","year":"2017","journal-title":"IEEE Trans. Veh. Technol."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/21\/13\/4409\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T06:25:20Z","timestamp":1760163920000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/21\/13\/4409"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2021,6,27]]},"references-count":38,"journal-issue":{"issue":"13","published-online":{"date-parts":[[2021,7]]}},"alternative-id":["s21134409"],"URL":"https:\/\/doi.org\/10.3390\/s21134409","relation":{},"ISSN":["1424-8220"],"issn-type":[{"type":"electronic","value":"1424-8220"}],"subject":[],"published":{"date-parts":[[2021,6,27]]}}}