Energy-optimal trajectory planning for car-like robots
Tóm tắt
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.
Tài liệu tham khảo
Balkcom, D., & Mason, M. (2002). Time optimal trajectories for bounded velocity differential drive vehicles. The International Journal of Robotics Research, 21(3), 199.
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.
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.
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.
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.
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.
Fraichard, T., & Scheuer, A. (2004). From reeds and shepp’s to continuous-curvature paths. IEEE Transactions on Robotics, 20(6), 1025–1035.
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.
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.
Guzzella, L., & Sciarretta, A. (2013). Vehicle propulsion systems: Introduction to modeling and optimization, 3rd edn. Berlin: Springer.
Hull, D. (2003). Optimal control theory for applications. New york: Springer.
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).
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).
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.
Kirk, D. (1970). Optimal control theory: An introduction. New York: Prentice Hall.
Lamiraux, F., & Lammond, J. P. (2001). Smooth motion planning for car-like vehicles. IEEE Transactions on Robotics and Automation, 17(4), 498–501.
LaValle, S. M., & Kuffner, J. J. (2001). Randomized kinodynamic planning. The International Journal of Robotics Research, 20(5), 378–400.
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.
Motors, D. C. (1977). Speed controls, servo systems: An engineering handbook. Hopkins: Electro-Craft Corporation.
Reeds, J., & Shepp, L. (1990). Optimal paths for a car that goes both forwards and backwards. Pacific Journal of Mathematics, 145(2), 367–393.
Ş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. http://ompl.kavrakilab.org. Accessed 30 Mar 2013.
Sun, Z., & Reif, J. (2005). On finding energy-minimizing paths on terrains. IEEE Transactions on Robotics, 21(1), 102–114.
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.
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.
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.