{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,10,12]],"date-time":"2025-10-12T04:27:36Z","timestamp":1760243256658,"version":"build-2065373602"},"reference-count":31,"publisher":"MDPI AG","issue":"4","license":[{"start":{"date-parts":[[2014,12,11]],"date-time":"2014-12-11T00:00:00Z","timestamp":1418256000000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/100003077","name":"Knowledge Foundation","doi-asserted-by":"publisher","award":["20100235"],"award-info":[{"award-number":["20100235"]}],"id":[{"id":"10.13039\/100003077","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Robotics"],"abstract":"<jats:p>Autonomous navigation in real-world industrial environments is a challenging task in many respects. One of the key open challenges is fast planning and execution of trajectories to reach arbitrary target positions and orientations with high accuracy and precision, while taking into account non-holonomic vehicle constraints. In recent years, lattice-based motion planners have been successfully used to generate kinematically and kinodynamically feasible motions for non-holonomic vehicles. However, the discretized nature of these algorithms induces discontinuities in both state and control space of the obtained trajectories, resulting in a mismatch between the achieved and the target end pose of the vehicle. As endpose accuracy is critical for the successful loading and unloading of cargo in typical industrial applications, automatically planned paths have not been widely adopted in commercial AGV systems. The main contribution of this paper is a path smoothing approach, which builds on the output of a lattice-based motion planner to generate smooth drivable trajectories for non-holonomic industrial vehicles. The proposed approach is evaluated in several industrially relevant scenarios and found to be both fast (less than 2 s per vehicle trajectory) and accurate (end-point pose errors below 0.01 m in translation and 0.005 radians in orientation).<\/jats:p>","DOI":"10.3390\/robotics3040400","type":"journal-article","created":{"date-parts":[[2014,12,11]],"date-time":"2014-12-11T10:53:38Z","timestamp":1418295218000},"page":"400-416","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":5,"title":["Drive the Drive: From Discrete Motion Plans to Smooth Drivable Trajectories"],"prefix":"10.3390","volume":"3","author":[{"given":"Henrik","family":"Andreasson","sequence":"first","affiliation":[{"name":"Centre of Applied Autonomous Sensor Systems (AASS), \u00d6rebro University, 70182 \u00d6rebro, Sweden"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Jari","family":"Saarinen","sequence":"additional","affiliation":[{"name":"Centre of Applied Autonomous Sensor Systems (AASS), \u00d6rebro University, 70182 \u00d6rebro, Sweden"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Marcello","family":"Cirillo","sequence":"additional","affiliation":[{"name":"Centre of Applied Autonomous Sensor Systems (AASS), \u00d6rebro University, 70182 \u00d6rebro, Sweden"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"given":"Todor","family":"Stoyanov","sequence":"additional","affiliation":[{"name":"Centre of Applied Autonomous Sensor Systems (AASS), \u00d6rebro University, 70182 \u00d6rebro, Sweden"}],"role":[{"role":"author","vocabulary":"crossref"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-0217-9326","authenticated-orcid":false,"given":"Achim","family":"Lilienthal","sequence":"additional","affiliation":[{"name":"Centre of Applied Autonomous Sensor Systems (AASS), \u00d6rebro University, 70182 \u00d6rebro, Sweden"}],"role":[{"role":"author","vocabulary":"crossref"}]}],"member":"1968","published-online":{"date-parts":[[2014,12,11]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","unstructured":"Bouguerra, A., Andreasson, H., Lilienthal, A.J., \u00c5strand, B., and R\u00f6gnvaldsson, T. (2009, January 23\u201325). MALTA: A System of Multiple Autonomous Trucks for Load Transportation. Proceedings of the European Conference on Mobile Robots (ECMR), Mlini\/Dubrovnik, Croatia.","DOI":"10.1109\/ETFA.2009.5347247"},{"key":"ref_2","doi-asserted-by":"crossref","unstructured":"Magnusson, M., and Almqvist, H. (2011, January 25\u201330). Consistent Pile-Shape Quantification for Autonomous Wheel Loaders. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), San Francisco, CA, USA.","DOI":"10.1109\/IROS.2011.6095031"},{"key":"ref_3","unstructured":"Kollmorgen web page. Available online: http:www.kollmorgen.com."},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"488","DOI":"10.1109\/TRO.2007.913993","article-title":"Improving the performance of sampling-based motion planning with symmetry-based gap reduction","volume":"24","author":"Cheng","year":"2008","journal-title":"IEEE Trans. Robot."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"151","DOI":"10.1177\/0278364911429977","article-title":"Using Lie group symmetries for fast corrective motion planning","volume":"31","author":"Seiler","year":"2012","journal-title":"Int. J. Robot. Res."},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"216","DOI":"10.1504\/IJVAS.2006.012208","article-title":"Follow the past: A path-tracking algorithm for autonomous vehicles","volume":"4","author":"Hellstrom","year":"2006","journal-title":"Int. J. Veh. Auton. Syst."},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"400","DOI":"10.1002\/rob.20242","article-title":"Autonomous underground tramming for center-articulated vehicles","volume":"25","author":"Marshall","year":"2008","journal-title":"J. Field Robot."},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"LaValle, S.M. (2006). Planning Algorithms, Cambridge University Press.","DOI":"10.1017\/CBO9780511546877"},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"566","DOI":"10.1109\/70.508439","article-title":"Probabilistic roadmaps for path planning in high-dimensional configuration spaces","volume":"12","author":"Kavraki","year":"1996","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_10","unstructured":"LaValle, S.M. (1998). Rapidly-Exploring Random Trees: A New Tool for Path Planning, Computer Science Department, Iowa State University. Technical Report, TR 98-11."},{"key":"ref_11","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_12","unstructured":"Islam, F., Nasir, J., Malik, U., Ayaz, Y., and Hasan, O. (2012, January 5\u20138). RRT*-Smart: Rapid convergence implementation of RRT* towards optimal solution. Proceedings of the International Conference on Mechatronics and Automation (ICMA), Chengdu, China."},{"key":"ref_13","unstructured":"Ferguson, D., and Likhachev, M. (2008, January 19\u201323). Efficiently using cost maps for planning complex maneuvers. Proceedings of the ICRA Workshop on Planning with Cost Maps, Pasadena, California, USA."},{"key":"ref_14","unstructured":"Pivtoraiko, M., and Kelly, A. (2009, January 12\u201317). Fast and Feasible Deliberative Motion Planner for Dynamic Environments. Proceedings of the ICRA Workshop on Safe Navigation in Open and Dynamic Environments: Application to Autonomous Vehicles, Kobe, Japan."},{"key":"ref_15","unstructured":"Koenig, S., and Likhachev, M. (August, January 28). D* Lite. Proceedings of the National Conference on Artificial Intelligence (AAAI), Edmonton, Alberta, Canada."},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"Lau, B., Sprunk, C., and Burgard, W. (2009, January 11\u201315). Kinodynamic Motion Planning for Mobile Robots Using Splines. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), St.Louis, MO, USA.","DOI":"10.1109\/IROS.2009.5354805"},{"key":"ref_17","unstructured":"Walther, M., Steinhaus, P., and Dillmann, R. (2005, January 7\u201310). Using B-Splines for Mobile Robot Path Representation and Motion Control. Proceedings of the European Conference on Mobile Robots (ECMR), Ancona, Italy."},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Sprunk, C., Lau, B., and Burgard, W. (2012, January 14\u201318). Improved Non-linear Spline Fitting for Teaching Trajectories to Mobile Robots. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), St. Paul, MN, USA.","DOI":"10.1109\/ICRA.2012.6224920"},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Wilde, D.K. (2009, January 11\u201315). Computing clothoid segments for trajectory generation. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), St. Louis, MO, USA.","DOI":"10.1109\/IROS.2009.5354700"},{"key":"ref_20","unstructured":"Brezak, M., and Petrovic, I. (September, January 28). Path Smoothing Using Clothoids for Differential Drive Mobile Robots. Proceedings of the 18th IFAC World Congress, Milano, Italy."},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Sprunk, C., Lau, B., Pfaff, P., and Burgard, W. (2011, January 9\u201313). Online Generation of Kinodynamic Trajectories for Non-Circular Omnidirectional Robots. Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980146"},{"key":"ref_22","doi-asserted-by":"crossref","unstructured":"Cirillo, M., Uras, T., Koenig, S., Andreasson, H., and Pecora, F. (2014, January 21\u201326). Integrated Motion Planning and Coordination for Industrial Vehicles. Proceedings of the 24th International Conference on Automated Planning and Scheduling, Portsmouth, NH, USA.","DOI":"10.1609\/icaps.v24i1.13668"},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Pecora, F., Cirillo, M., and Dimitrov, D. (2012, January 7\u201312). On Mission-Dependent Coordination of Multiple Vehicles under Spatial and Temporal Constraints. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Algarve, Portugal.","DOI":"10.1109\/IROS.2012.6385862"},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Cirillo, M., Uras, T., and Koenig, S. (2014, January 14\u201318). A Lattice-Based Approach to Multi-Robot Motion Planning for Non-Holonomic Vehicles. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Chicago, IL, USA.","DOI":"10.1109\/IROS.2014.6942566"},{"key":"ref_25","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_26","doi-asserted-by":"crossref","unstructured":"Pivtoraiko, M., and Kelly, A. (2011, January 25\u201330). Kinodynamic motion planning with state lattice motion primitives. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), San Francisco, CA, USA.","DOI":"10.1109\/IROS.2011.6094900"},{"key":"ref_27","first-page":"767","article-title":"ARA*: Anytime A* with provable bounds on sub-optimality","volume":"16","author":"Likhachev","year":"2003","journal-title":"Adv. Neural Inf. Process. Syst."},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Knepper, R.A., and Kelly, A. (2006, January 9\u201315). High Performance State Lattice Planning Using Heuristic Look-Up Tables. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Beijing, China.","DOI":"10.1109\/IROS.2006.282515"},{"key":"ref_29","doi-asserted-by":"crossref","first-page":"298","DOI":"10.1002\/oca.939","article-title":"ACADO Toolkit\u2014An Open Source Framework for Automatic Control and Dynamic Optimization","volume":"32","author":"Houska","year":"2011","journal-title":"Optim. Control Appl. Methods"},{"key":"ref_30","doi-asserted-by":"crossref","unstructured":"Bock, H., and Plitt, K. (1984, January 2\u20136). A Multiple Shooting algorithm for direct solution of optimal control problems. Proceedings of the 9th IFAC World Congress, Budapest, Hungary.","DOI":"10.1016\/S1474-6670(17)61205-9"},{"key":"ref_31","unstructured":"Munoz, V.F., and Ollero, A. (1996, January 9\u201312). Smooth trajectory planning method for mobile robots. Proceedings of the Conference on Computational Engineering in Systems Applications, Lille, France."}],"container-title":["Robotics"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2218-6581\/3\/4\/400\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T21:10:52Z","timestamp":1760217052000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2218-6581\/3\/4\/400"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2014,12,11]]},"references-count":31,"journal-issue":{"issue":"4","published-online":{"date-parts":[[2014,12]]}},"alternative-id":["robotics3040400"],"URL":"https:\/\/doi.org\/10.3390\/robotics3040400","relation":{},"ISSN":["2218-6581"],"issn-type":[{"type":"electronic","value":"2218-6581"}],"subject":[],"published":{"date-parts":[[2014,12,11]]}}}