Energy-optimal trajectory planning for car-like robots
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.
This material is based upon work supported by the National Science Foundation under Grant Nos. 0916209, 0917676 and 0936710.
- 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
- 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.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.Galassi, M., Davies, J., Theiler, J., Gough, B., Jungman, G., Alken, P., et al. (2007). GNU Scientific Library Reference Manual, 3rd edn. http://www.gnu.org/software/gsl/. Accessed 30 Mar 2013.
- 10.Guzzella, L., & Sciarretta, A. (2013). Vehicle propulsion systems: Introduction to modeling and optimization, 3rd edn. Berlin: Springer.Google Scholar
- 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.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
- 15.Kirk, D. (1970). Optimal control theory: An introduction. New York: Prentice Hall.Google Scholar
- 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.Motors, D. C. (1977). Speed controls, servo systems: An engineering handbook. Hopkins: Electro-Craft Corporation.Google Scholar
- 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.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.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