Abstract
This paper is concerned with the problem of finding a time-optimal velocity profile along the predefined path for static formations of mobile robots in order to traverse the path in shortest time and to satisfy, for each mobile robot in the formation, velocity, acceleration, tip over and wheel slip prevention constraints. Time-optimal velocity planning is achieved using so called bang-bang control where minimum and maximum accelerations of the formation are alternating. The developed trajectory planning algorithm is demonstrated on the formation of differential drive mobile robots.
Similar content being viewed by others
References
M. Dakulović and I. Petrović, “Two-way D* algorithm for path planning and replanning,” Robotics and autonomous systems, vol. 59, no. 5, pp. 329–342, May 2011.
Y. Abbasi-Yadkori, J. Modayil, and C. Szepesvari, “Extending rapidly-exploring random trees for asymptotically optimal anytime motion planning,” Proc. of International Conference on Intelligent Robots and Systems, pp. 127–132, October 2010.
G. Li, A. Yamashita, H. Asama, and Y. Tamura, “An efficient improved artificial potential field based regression search method for robot path planning,” Proc. of International Conference on Mechatronics and Automation, pp. 1227–1232, August 2012.
M. Brezak and I. Petrović, “Real-time approximation of clothoids with bounded error for path planning applications,” IEEE Transactions on Robotics, vol. 30, no. 2, pp. 507–515, April 2014.
T. Petrinić and I. Petrović, “A leader-follower approach to formation control of multiple non-holonomic mobile robots,” Proceedings of MIPRO 2013 36th International Convention, pp. 931–935, May 2013.
K. G. Shin and N. D. McKay, “Minimum-time control of robot manipulators with geometric path constraints,” IEEE Transaction on Automatic Control, vol. 30, no. 6, pp. 531–541, July 1985.
J. E. Bobrow, S. Dubowsky, and J. S. Gibson, “Timeoptimal control of robotic manipulators along specified paths,” The International Journal of Robotics Research, vol. 4, no. 3, pp. 3–17, September 1985.
K. Zhang, C.-M. Yuan, and X.-S. Gao, “Efficient algorithm for time-optimal feedrate planning and smoothing with confined chord error and acceleration,” The International Journal of Advanced Manufacturing Technology, vol. 66, no. 9, pp. 1685–1697, June 2013.
M. Lepetič, G. Klančar, I. Škrjanc, D. Matko, and B. Potočnik, “Time optimal path planning considering acceleration limits,” Robotics and Autonomous Systems, vol. 45, no. 3-4, pp. 199–210, December 2003.
B. Lau, C. Sprunk, and W. Burgard, “Kinodynamic motion planning for mobile robots using splines,” Proc. of IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 2427–2433, October 2009.
G. Lini, L. Consolini, and A. Piazzi, “Minimum-time constrained velocity planning,” Proc. of 17th Mediterranean Conference on Control and Automation, pp. 748–753, June 2009.
M. Brezak, Localization, Motion Planning and Control of Mobile Robots in Intelligent Spaces. PhD thesis, University of Zagreb, Faculty of Electrical Engineering and Computing, 2010.
Z. Shille and Y.-R. Gwo, “Dynamic motion planning of autonomous vehicles,” IEEE Transactions on Robotics and Automation, vol. 7, no. 2, April 1991.
M. Prado, A. Simon, E. Carabias, A. Perez, and F. Ezquerro, “Optimal velocity planning of wheeled mobile robots on specific paths in static and dynamic environments,” Journal of Robotic Systems, vol. 20, no. 12, pp. 737–754, December 2003.
Y. Huang, X. Zhang, and Y. Fang, “Vision-based minimum-time planning of mobile robots with kinematic and visibility constraints,” Proceedings of the 19th International Federation of Automatic Control World Congress, pp. 11878–11883, August 2014.
P. F. Lima, M. Trincavelli, J. Martensson, and B. Wahlberg, “Clothoid-Based Speed Profiler and Control for Autonomous Driving,” Proc. of IEEE 18th International Conference on Intelligent Transportation Systems, pp. 2194–2199, September 2015.
L. Consolini, F. Morbidi, and D. Prattichizzo, “Stabilization of a hierarchical formation of unicycle robots with velocity and curvature constraints,” IEEE Transactions on Robotics, vol. 25 no. 5, pp. 1176–1184, October 2009.
L. Consolini, F. Morbidi, D. Prattichizzo, and M. Tosques, “Leader–follower formation control of nonholonomic mobile robots with input constraints,” Automatica, vol. 44, no. 5, pp. 1343–1349, May 2008.
T. D. Barfoot and C. M. Clark, “Motion planning for formations of mobile robots,” Robotics and Autonomous Systems, vol. 46, no. 2, pp. 65–78, February 2004.
http://en.wikipedia.org/wiki/Euler_spiral
http://en.wikipedia.org/wiki/Parallel_curve
H. Choset, K. M. Lynch, S. Hutchinson, G. Kantor, W. Burgard, L. E. Kavraki, and S. Thrun, Principles of Robot Motion, MIT Press, 2005.
M. Brezak, I. Petrović, and E. Ivanjko, “Robust and accurate global vision system for real time tracking of multiple mobile robots,” Robotics and Autonomous Systems, vol. 56, pp. 213–230, March 2008.
M. Brezak, I. Petrović, and N. Perić, “Experimental comparison of trajectory tracking algorithms for nonholonomic mobile robots,” Proc. of 35th Annual Conference of the IEEE Industrial Electronics, pp. 2229–2234, November 2009.
Author information
Authors and Affiliations
Corresponding author
Additional information
Recommended by Associate Editor Sooyeong Yi under the direction of Editor Hyouk Ryeol Choi. This research has been partly supported by the Ministry of Science, Education and Sports of the Republic of Croatia under the grant “Centre of Research Excellence for Data Science and Cooperative Systems.”
Toni Petrinić received his B.Sc. degree in Electrical Engineering from the Faculty of Electrical Engineering and Computing (FER Zagreb), University of Zagreb, Croatia, in 2005. Since 2006 he has been with HEP-ODS d.o.o., Elektroprimorje Rijeka, Pogon Cres-Lošinj, where he is currently a head of technical department. His main research interest is in the field of mobile robotics.
Mišel Brezak received his Ph.D. degree in Electrical Engineering from the Faculty of Electrical Engineering and Computing (FER Zagreb), University of Zagreb, Croatia, in 2010. His main research interests are in the fields of mobile robotics and computer vision. He published 4 journal and more than 20 conference papers.
Ivan Petrović received his B.Sc. degree in 1983, an M.Sc. degree in 1989 and a Ph.D. degree in 1998, all in Electrical Engineering from the Faculty of Electrical Engineering and Computing (FER Zagreb), University of Zagreb, Croatia. He had been employed as an R&D engineer at the Institute of Electrical Engineering of the Končar Corporation in Zagreb from 1985 to 1994. Since 1994 he has been with FER Zagreb, where he is currently a full professor. He teaches a number of undergraduate and graduate courses in the field of control systems and mobile robotics. His research interests include various advanced control strategies and their applications to control of complex systems and mobile robots navigation. He has published more than 40 journal and 160 conference papers, and results of his research have been implemented in several industrial products. He is a member of IEEE, IFAC–TC on Robotics and FIRA–Executive committee. He is a member of the Croatian Academy of Engineering.
Rights and permissions
About this article
Cite this article
Petrinić, T., Brezak, M. & Petrović, I. Time-optimal velocity planning along predefined path for static formations of mobile robots. Int. J. Control Autom. Syst. 15, 293–302 (2017). https://doi.org/10.1007/s12555-015-0192-y
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s12555-015-0192-y