{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,2,28]],"date-time":"2026-02-28T04:27:37Z","timestamp":1772252857475,"version":"3.50.1"},"reference-count":48,"publisher":"MDPI AG","issue":"7","license":[{"start":{"date-parts":[[2018,7,6]],"date-time":"2018-07-06T00:00:00Z","timestamp":1530835200000},"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>In this paper, we present a complete, flexible and safe convex-optimization-based method to solve speed planning problems over a fixed path for autonomous driving in both static and dynamic environments. Our contributions are five fold. First, we summarize the most common constraints raised in various autonomous driving scenarios as the requirements for speed planner developments and metrics to measure the capacity of existing speed planners roughly for autonomous driving. Second, we introduce a more general, flexible and complete speed planning mathematical model including all the summarized constraints compared to the state-of-the-art speed planners, which addresses limitations of existing methods and is able to provide smooth, safety-guaranteed, dynamic-feasible, and time-efficient speed profiles. Third, we emphasize comfort while guaranteeing fundamental motion safety without sacrificing the mobility of cars by treating the comfort box constraint as a semi-hard constraint in optimization via slack variables and penalty functions, which distinguishes our method from existing ones. Fourth, we demonstrate that our problem preserves convexity with the added constraints, thus global optimality of solutions is guaranteed. Fifth, we showcase how our formulation can be used in various autonomous driving scenarios by providing several challenging case studies in both static and dynamic environments. A range of numerical experiments and challenging realistic speed planning case studies have depicted that the proposed method outperforms existing speed planners for autonomous driving in terms of constraint type covered, optimality, safety, mobility and flexibility.<\/jats:p>","DOI":"10.3390\/s18072185","type":"journal-article","created":{"date-parts":[[2018,7,6]],"date-time":"2018-07-06T10:55:44Z","timestamp":1530874544000},"page":"2185","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":30,"title":["Toward a More Complete, Flexible, and Safer Speed Planning for Autonomous Driving via Convex Optimization"],"prefix":"10.3390","volume":"18","author":[{"ORCID":"https:\/\/orcid.org\/0000-0003-0090-4125","authenticated-orcid":false,"given":"Yu","family":"Zhang","sequence":"first","affiliation":[{"name":"School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China"}]},{"given":"Huiyan","family":"Chen","sequence":"additional","affiliation":[{"name":"School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-4217-4415","authenticated-orcid":false,"given":"Steven L.","family":"Waslander","sequence":"additional","affiliation":[{"name":"University of Toronto Institute of Aerospace Studies, Toronto, ON M3H 5T6, Canada"}]},{"given":"Tian","family":"Yang","sequence":"additional","affiliation":[{"name":"School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China"}]},{"given":"Sheng","family":"Zhang","sequence":"additional","affiliation":[{"name":"School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China"}]},{"given":"Guangming","family":"Xiong","sequence":"additional","affiliation":[{"name":"School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-8225-851X","authenticated-orcid":false,"given":"Kai","family":"Liu","sequence":"additional","affiliation":[{"name":"School of Mechanical Engineering, Beijing Institute of Technology, Beijing 100081, China"}]}],"member":"1968","published-online":{"date-parts":[[2018,7,6]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"271","DOI":"10.1504\/IJVAS.2012.051270","article-title":"Autonomous vehicle control at the limits of handling","volume":"10","author":"Kritayakirana","year":"2012","journal-title":"Int. J. Veh. Auton. Syst."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"2318","DOI":"10.1109\/TAC.2009.2028959","article-title":"Time-optimal path tracking for robots: A convex optimization approach","volume":"54","author":"Verscheure","year":"2009","journal-title":"IEEE Trans. Autom. Control"},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"1297","DOI":"10.1080\/00207179.2013.875224","article-title":"Minimum-time speed optimisation over a fixed path","volume":"87","author":"Lipp","year":"2014","journal-title":"Int. J. Control"},{"key":"ref_4","doi-asserted-by":"crossref","unstructured":"Dakibay, A., and Waslander, S.L. (2017, January 16\u201319). Aggressive Vehicle Control Using Polynomial Spiral Curves. Proceedings of the IEEE International Conference on Intelligent Transportation Systems (ITSC), Yokohama, Japan.","DOI":"10.1109\/ITSC.2017.8317881"},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Cabrera, J.A., Castillo, J.J., P\u00e9rez, J., Velasco, J.M., Guerra, A.J., and Hern\u00e1ndez, P. (2018). A procedure for determining tire-road friction characteristics using a modification of the magic formula based on experimental results. Sensors, 18.","DOI":"10.3390\/s18030896"},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Yunta, J., Garcia-Pozuelo, D., Diaz, V., and Olatunbosun, O. (2018). A Strain-Based Method to Detect Tires\u0139oss of Grip and Estimate Lateral Friction Coefficient from Experimental Data by Fuzzy Logic for Intelligent Tire Development. Sensors, 18.","DOI":"10.3390\/s18020490"},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"740","DOI":"10.1109\/TMECH.2015.2493980","article-title":"Real-time trajectory planning for autonomous urban driving: Framework, Algorithms, and Verifications","volume":"21","author":"Li","year":"2016","journal-title":"IEEE\/ASME Trans. Mechatron."},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Gu, T., Snider, J., Dolan, J.M., and Lee, J.W. (2013, January 23\u201326). Focused trajectory planning for autonomous on-road driving. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Gold Coast, Australia.","DOI":"10.1109\/IVS.2013.6629524"},{"key":"ref_9","unstructured":"Gu, T. (2017). Improved Trajectory Planning for On-Road Self-Driving Vehicles Via Combined Graph Search, Optimization & Topology Analysis. [Ph.D. Thesis, Carnegie Mellon University]."},{"key":"ref_10","unstructured":"Gu, T., Atwood, J., Dong, C., Dolan, J.M., and Lee, J.W. (October, January 28). Tunable and stable real-time trajectory planning for urban autonomous driving. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Hamburg, Germany."},{"key":"ref_11","doi-asserted-by":"crossref","unstructured":"Liu, C., Zhan, W., and Tomizuka, M. (2017, January 11\u201314). Speed profile planning in dynamic environments via temporal optimization. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Los Angeles, CA, USA.","DOI":"10.1109\/IVS.2017.7995713"},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Wei, J., Dolan, J.M., and Litkouhi, B. (2013, January 23\u201326). Autonomous vehicle social behavior for highway entrance ramp management. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Gold Coast, Australia.","DOI":"10.1109\/IVS.2013.6629471"},{"key":"ref_13","doi-asserted-by":"crossref","first-page":"136","DOI":"10.1080\/15472450.2016.1248288","article-title":"Collaborative merging strategy for freeway ramp operations in a connected and autonomous vehicles environment","volume":"21","author":"Xie","year":"2017","journal-title":"J. Intell. Transp. Syst."},{"key":"ref_14","doi-asserted-by":"crossref","unstructured":"Serna, C.G., and Ruichek, Y. (2017). Dynamic speed adaptation for path tracking based on curvature information and speed limits. Sensors, 17.","DOI":"10.3390\/s17061383"},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"30","DOI":"10.1016\/j.advengsoft.2015.04.011","article-title":"Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robots","volume":"87","author":"Li","year":"2015","journal-title":"Adv. Eng. Softw."},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"Ziegler, J., Bender, P., Dang, T., and Stiller, C. (2014, January 8\u201311). Trajectory planning for Bertha\u2014A local, continuous method. Proceedings of the 2014 IEEE Intelligent Vehicles Symposium, Dearborn, MI, USA.","DOI":"10.1109\/IVS.2014.6856581"},{"key":"ref_17","unstructured":"Schwarting, W., Alonso-Mora, J., Pauli, L., Karaman, S., and Rus, D. (3, January 29). Parallel autonomy in automated vehicles: Safe motion generation with minimal intervention. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Singapore."},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Ziegler, J., and Stiller, C. (2009, January 10\u201315). Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios. Proceedings of the 2009 IEEE\/RSJ International Conference on Intelligent Robots and Systems, St. Louis, MO, USA.","DOI":"10.1109\/IROS.2009.5354448"},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"McNaughton, M., Urmson, C., Dolan, J.M., and Lee, J.W. (2011, January 9\u201313). Motion planning for autonomous driving with a conformal spatiotemporal lattice. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980223"},{"key":"ref_20","unstructured":"Zhu, Z., Schmerling, E., and Pavone, M. (2015, January 15\u201318). A convex optimization approach to smooth trajectories for motion planning with car-like robots. Proceedings of the IEEE 54th Annual Conference on Decision and Control (CDC), Osaka, Japan."},{"key":"ref_21","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_22","doi-asserted-by":"crossref","unstructured":"Zhang, Y., Chen, H., Waslander, S.L., Gong, J., Xiong, G., Yang, T., and Liu, K. (2018). Hybrid Trajectory Planning for Autonomous Driving in Highly Constrained Environments. IEEE Access.","DOI":"10.1109\/ACCESS.2018.2845448"},{"key":"ref_23","first-page":"233","article-title":"Collision-free and curvature-continuous path smoothing in cluttered environments","volume":"17","author":"Pan","year":"2012","journal-title":"Robot. Sci. Syst. VII"},{"key":"ref_24","doi-asserted-by":"crossref","first-page":"406","DOI":"10.1109\/TITS.2015.2477355","article-title":"Randomized bidirectional B-spline parameterization motion planning","volume":"17","author":"Elbanhawi","year":"2016","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_25","doi-asserted-by":"crossref","first-page":"561","DOI":"10.1109\/TRO.2010.2042990","article-title":"An analytical continuous-curvature path-smoothing algorithm","volume":"26","author":"Yang","year":"2010","journal-title":"IEEE Trans. Robot."},{"key":"ref_26","doi-asserted-by":"crossref","unstructured":"Han, L., Yashiro, H., Nejad, H.T.N., Do, Q.H., and Mita, S. (2010, January 21\u201324). Bezier curve based path planning for autonomous vehicle in urban environment. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), San Diego, CA, USA.","DOI":"10.1109\/IVS.2010.5548085"},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Funke, J., and Gerdes, J.C. (2013, January 21\u201323). Simple clothoid paths for autonomous vehicle lane changes at the limits of handling. Proceedings of the ASME 2013 Dynamic Systems and Control Conference, Palo Alto, CA, USA.","DOI":"10.1115\/DSCC2013-3947"},{"key":"ref_28","unstructured":"Knowles, D. (2006). Real Time Continuous Curvature Path Planner for an Autonomous Vehicle in an Urban Environment, California Institute of Technology. Technical Report."},{"key":"ref_29","doi-asserted-by":"crossref","unstructured":"Lee, J.W., and Litkouhi, B. (2012, January 16\u201319). A unified framework of the automated lane centering\/changing control for motion smoothness adaptation. Proceedings of the IEEE International Conference on Intelligent Transportation Systems (ITSC), Anchorage, AK, USA.","DOI":"10.1109\/ITSC.2012.6338738"},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"583","DOI":"10.1177\/02783649030227008","article-title":"Reactive nonholonomic trajectory generation via parametric optimal control","volume":"22","author":"Kelly","year":"2003","journal-title":"Int. J. Robot. Res."},{"key":"ref_31","unstructured":"Matthew, M. (2011). Parallel Algorithms for Real-Time Motion Planning. [Ph.D. Thesis, Carnegie Mellon University]."},{"key":"ref_32","unstructured":"Rajamani, R. (2006). Vehicle Dynamics and Control, Springer."},{"key":"ref_33","doi-asserted-by":"crossref","unstructured":"Polack, P., Altch\u00e9, F., d\u2019Andr\u00e9a Novel, B., and de La Fortelle, A. (2017, January 11\u201314). The kinematic bicycle model: A consistent model for planning feasible trajectories for autonomous vehicles?. Proceedings of the IEEE Intelligent Vehicles Symposium (IV), Los Angeles, CA, USA.","DOI":"10.1109\/IVS.2017.7995816"},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"233","DOI":"10.1002\/(SICI)1097-4563(200005)17:5<233::AID-ROB1>3.0.CO;2-Y","article-title":"Smooth and time-optimal trajectory planning for industrial manipulators along specified paths","volume":"17","author":"Constantinescu","year":"2000","journal-title":"J. Robot. Syst."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"42","DOI":"10.1109\/TRA.2002.807548","article-title":"Jerk-bounded manipulator trajectory planning: Design for real-time applications","volume":"19","author":"Macfarlane","year":"2003","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_36","doi-asserted-by":"crossref","first-page":"2126","DOI":"10.1109\/TBME.2011.2179545","article-title":"A Robust and Sensitive Metric for Quantifying Movement Smoothness","volume":"59","author":"Balasubramanian","year":"2012","journal-title":"IEEE Trans. Biomed. Eng."},{"key":"ref_37","doi-asserted-by":"crossref","first-page":"112","DOI":"10.1186\/s12984-015-0090-9","article-title":"On the analysis of movement smoothness","volume":"12","author":"Balasubramanian","year":"2015","journal-title":"J. Neuroeng. Rehabil."},{"key":"ref_38","unstructured":"Chachuat, B. (2007). Nonlinear and Dynamic Optimization: From Theory to Practice, Automatic Control Laboratory EPFL. Technical Report."},{"key":"ref_39","doi-asserted-by":"crossref","unstructured":"Schwesinger, U., Siegwart, R., and Furgale, P. (2015, January 26\u201330). Fast collision detection through bounding volume hierarchies in workspace-time space for sampling-based motion planners. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Seattle, WA, USA.","DOI":"10.1109\/ICRA.2015.7138981"},{"key":"ref_40","doi-asserted-by":"crossref","unstructured":"Boyd, S., and Vandenberghe, L. (2004). Convex Optimization, Cambridge University Press.","DOI":"10.1017\/CBO9780511804441"},{"key":"ref_41","doi-asserted-by":"crossref","first-page":"51","DOI":"10.1016\/j.ejcon.2015.05.003","article-title":"Fast model predictive control with soft constraints","volume":"25","author":"Richards","year":"2015","journal-title":"Eur. J. Control"},{"key":"ref_42","doi-asserted-by":"crossref","unstructured":"Rockafellar, R.T. (1970). Convex Analysis, Princeton University Press.","DOI":"10.1515\/9781400873173"},{"key":"ref_43","doi-asserted-by":"crossref","unstructured":"Udell, M., Mohan, K., Zeng, D., Hong, J., Diamond, S., and Boyd, S. (2014, January 16\u201321). Convex Optimization in Julia. Proceedings of the 1st First Workshop for High Performance Technical Computing in Dynamic Languages (HPTCDL \u201914), New Orleans, LA, USA.","DOI":"10.1109\/HPTCDL.2014.5"},{"key":"ref_44","unstructured":"Optimization, G. (2016). Gurobi Optimizer Reference Manual, Gurobi Optimization Inc."},{"key":"ref_45","doi-asserted-by":"crossref","first-page":"65","DOI":"10.1137\/141000671","article-title":"Julia: A fresh approach to numerical computing","volume":"59","author":"Bezanson","year":"2017","journal-title":"SIAM Rev."},{"key":"ref_46","unstructured":"Milliken, W.F., and Milliken, D.L. (1995). Race Car Vehicle Dynamics, Society of Automotive Engineers."},{"key":"ref_47","doi-asserted-by":"crossref","unstructured":"Rice, R.S. (1973). Measuring Car-Driver Interaction with the g-g Diagram, SAE International. Technical Report.","DOI":"10.4271\/730018"},{"key":"ref_48","doi-asserted-by":"crossref","first-page":"50","DOI":"10.1016\/j.sysconle.2017.02.001","article-title":"An optimal complexity algorithm for minimum-time velocity planning","volume":"103","author":"Consolini","year":"2017","journal-title":"Syst. Control Lett."}],"container-title":["Sensors"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/1424-8220\/18\/7\/2185\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T15:11:36Z","timestamp":1760195496000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/1424-8220\/18\/7\/2185"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2018,7,6]]},"references-count":48,"journal-issue":{"issue":"7","published-online":{"date-parts":[[2018,7]]}},"alternative-id":["s18072185"],"URL":"https:\/\/doi.org\/10.3390\/s18072185","relation":{"has-preprint":[{"id-type":"doi","id":"10.20944\/preprints201805.0164.v1","asserted-by":"object"},{"id-type":"doi","id":"10.20944\/preprints201805.0164.v2","asserted-by":"object"}]},"ISSN":["1424-8220"],"issn-type":[{"value":"1424-8220","type":"electronic"}],"subject":[],"published":{"date-parts":[[2018,7,6]]}}}