Autonomous Robots

, Volume 37, Issue 3, pp 279–300 | Cite as

Energy-optimal trajectory planning for car-like robots

  • Pratap Tokekar
  • Nikhil Karnad
  • Volkan Isler


When a battery-powered robot needs to operate for a long period of time, optimizing its energy consumption becomes critical. Driving motors are a major source of power consumption for mobile robots. In this paper, we study the problem of finding optimal paths and velocity profiles for car-like robots so as to minimize the energy consumed during motion. We start with an established model for energy consumption of DC motors. We first study the problem of finding the energy optimal velocity profiles, given a path for the robot. We present closed form solutions for the unconstrained case and for the case where there is a bound on maximum velocity. We then study a general problem of finding an energy optimal path along with a velocity profile, given a starting and goal position and orientation for the robot. Along the path, the instantaneous velocity of the robot may be bounded as a function of its turning radius, which in turn affects the energy consumption. Unlike minimum length paths, minimum energy paths may contain circular segments of varying radii. We show how to efficiently construct a graph which generalizes Dubins’ paths by including segments with arbitrary radii. Our algorithm uses the closed-form solution for the optimal velocity profiles as a subroutine to find the minimum energy trajectories, up to a fine discretization. We investigate the structure of energy-optimal paths and highlight instances where these paths deviate from the minimum length Dubins’ curves. In addition, we present a calibration method to find energy model parameters. Finally, we present results from experiments conducted on a custom-built robot for following optimal velocity profiles.


Energy-efficiency Trajectory-planning 



This material is based upon work supported by the National Science Foundation under Grant Nos. 0916209, 0917676 and 0936710.


  1. 1.
    Balkcom, D., & Mason, M. (2002). Time optimal trajectories for bounded velocity differential drive vehicles. The International Journal of Robotics Research, 21(3), 199.CrossRefGoogle Scholar
  2. 2.
    Broderick, J. A., Tilbury, D. M., & Atkins, E. M. (2014). Optimal coverage trajectories for a ugv with tradeoffs for energy and time. Autonomous Robots, 36(3), 257–271.CrossRefGoogle Scholar
  3. 3.
    Chitsaz, H., LaValle, S., Balkcom, D., & Mason, M. (2009). Minimum wheel-rotation paths for differential-drive mobile robots. The International Journal of Robotics Research, 28(1), 66.CrossRefGoogle Scholar
  4. 4.
    Ding, L., Deng, Z., Gao, H., Nagatani, K., & Yoshida, K. (2011). Planetary rovers’ wheel–soil interaction mechanics: new challenges and applications for wheeled mobile robots. Intelligent Service Robotics, 4(1), 17–38.Google Scholar
  5. 5.
    Donald, B., Xavier, P., Canny, J., & Reif, J. (1993). Kinodynamic motion planning. Journal of the ACM, 40(5), 1048–1066. doi: 10.1145/174147.174150.CrossRefzbMATHMathSciNetGoogle Scholar
  6. 6.
    Dubins, L. (1957). On curves of minimal length with a constraint on average curvature, and with prescribed initial and terminal positions and tangents. American Journal of Mathematics, 79(3), 497–516. Google Scholar
  7. 7.
    Fraichard, T., & Scheuer, A. (2004). From reeds and shepp’s to continuous-curvature paths. IEEE Transactions on Robotics, 20(6), 1025–1035.Google Scholar
  8. 8.
    Galassi, M., Davies, J., Theiler, J., Gough, B., Jungman, G., Alken, P., et al. (2007). GNU Scientific Library Reference Manual, 3rd edn. Accessed 30 Mar 2013.
  9. 9.
    Gregory, J., Olivares, A., & Staffetti, E. (2012). Energy-optimal trajectory planning for robot manipulators with holonomic constraints. Systems and Control Letters, 61(2), 279–291.CrossRefzbMATHMathSciNetGoogle Scholar
  10. 10.
    Guzzella, L., & Sciarretta, A. (2013). Vehicle propulsion systems: Introduction to modeling and optimization, 3rd edn. Berlin: Springer.Google Scholar
  11. 11.
    Hull, D. (2003). Optimal control theory for applications. New york: Springer.CrossRefzbMATHGoogle Scholar
  12. 12.
    Karaman, S., & Frazzoli, E. (2010). Optimal kinodynamic motion planning using incremental sampling-based methods. In: 49th IEEE Conference on Decision and Control (CDC), 2010 (pp. 7681–7687).Google Scholar
  13. 13.
    Kim, C., & Kim, B. (2007). Minimum-Energy Rotational Trajectory Planning for Differential-Driven Wheeled Mobile Robots. In: Proceedings of 13th International Conference on Advanced Robotics (pp. 265–270).Google Scholar
  14. 14.
    Kim, C., & Kim, B. (2007). Minimum-energy translational trajectory generation for differential-driven wheeled mobile robots. Journal of Intelligent and Robotic Systems, 49(4), 367–383.CrossRefGoogle Scholar
  15. 15.
    Kirk, D. (1970). Optimal control theory: An introduction. New York: Prentice Hall.Google Scholar
  16. 16.
    Lamiraux, F., & Lammond, J. P. (2001). Smooth motion planning for car-like vehicles. IEEE Transactions on Robotics and Automation, 17(4), 498–501.CrossRefGoogle Scholar
  17. 17.
    LaValle, S. M., & Kuffner, J. J. (2001). Randomized kinodynamic planning. The International Journal of Robotics Research, 20(5), 378–400.CrossRefGoogle Scholar
  18. 18.
    Mei, Y., Lu, Y., Hu, Y., & Lee, C. (2004). Energy-efficient motion planning for mobile robots. In Proceedings of IEEE International Conference on Robotics and Automation.Google Scholar
  19. 19.
    Motors, D. C. (1977). Speed controls, servo systems: An engineering handbook. Hopkins: Electro-Craft Corporation.Google Scholar
  20. 20.
    Reeds, J., & Shepp, L. (1990). Optimal paths for a car that goes both forwards and backwards. Pacific Journal of Mathematics, 145(2), 367–393.CrossRefMathSciNetGoogle Scholar
  21. 21.
    Şucan, I.A., Moll, M., & Kavraki, L.E. (2012). The Open Motion Planning Library. IEEE Robotics & Automation Magazine 19(4), pp. 72–82, doi: 10.1109/MRA.2012.2205651. Accessed 30 Mar 2013.
  22. 22.
    Sun, Z., & Reif, J. (2005). On finding energy-minimizing paths on terrains. IEEE Transactions on Robotics, 21(1), 102–114.CrossRefGoogle Scholar
  23. 23.
    Tokekar, P., Karnad, N., & Isler, V. (2011). Energy-optimal velocity profiles for car-like robots. In Proceedings of IEEE International Conference on Robotics and Automation.Google Scholar
  24. 24.
    Wang, G., Irwin, M., Berman, P., Fu, H., & La Porta, T. (2005). Optimizing sensor movement planning for energy efficiency. In Proceedings of the ACM International Symposium on Low power electronics and design.Google Scholar
  25. 25.
    Wigstrom, O., Lennartson, B., Vergnano, A., & Breitholtz, C. (2013). High-level scheduling of energy optimal trajectories. IEEE Transactions on Automation Science and Engineering, 10(1), 57–64.Google Scholar

Copyright information

© Springer Science+Business Media New York 2014

Authors and Affiliations

  1. 1.Department of Computer Science & EngineeringUniversity of MinnesotaMinneapolisUSA

Personalised recommendations