Abstract
Replanning is a powerful mechanism for controlling robot motion under hard constraints and unpredictable disturbances, but it involves an inherent tradeoff between the planner’s power (e.g., a planning horizon or time cutoff) and its responsiveness to disturbances. This paper presents an adaptive time-stepping architecture for real-time planning with several advantageous properties. By dynamically adapting to the amount of time needed for a sample-based motion planner to make progress toward the goal, the technique is robust to the typically high variance exhibited by replanning queries. The technique is proven to be safe and asymptotically complete in a deterministic environment and a static objective. For unpredictably moving obstacles, the technique can be applied to keep the robot safe more reliably than reactive obstacle avoidance or fixed time-step replanning. It can also be applied in a contingency planning algorithm that achieves simultaneous safety-seeking and goal-seeking motion. These techniques generate responsive and safe motion in both simulated and real robots across a range of difficulties, including applications to bounded-acceleration pursuit-evasion, indoor navigation among moving obstacles, and aggressive collision-free teleoperation of an industrial robot arm.
Similar content being viewed by others
References
Allgöwer, F., & Zheng, A. (2000). Progress in systems and control theory. Nonlinear model predictive control. Basel: Birkhäuser.
Anderson, S. J., Peters, S. C., Iagnemma, K. D., & Pilutti, T. E. (2009). A unified approach to semi-autonomous control of passenger vehicles in hazard avoidance scenarios. In Proc. IEEE int. conf. on systems, man and cybernetics (pp. 2032–2037), San Antonio, TX, USA, 2009.
Bekris, K., & Kavraki, L. (2007). Greedy but safe replanning under kinodynamic constraints. In Proc. IEEE int. conference on robotics and automation (ICRA) (pp. 704–710), Rome, Italy, April 2007.
Bruce, J., & Veloso, M. (2002). Real-time randomized path planning for robot navigation. In IEEE international conference on intelligent robots and systems (IROS), Lausanne, Switzerland, October 2002.
Feron, E., Frazzoli, E., & Dahleh, M. (2000). Real-time motion planning for agile autonomous vehicles. In AIAA conference on guidance, navigation and control, Denver, USA, August 2000.
Fiorini, P., & Shiller, Z. (1998). Motion planning in dynamic environments using velocity obstacles. The International Journal of Robotics Research, 17(7), 760–772.
Ge, S. S., & Cui, Y. J. (2002). Dynamic motion planning for mobile robots using potential field method. Autonomous Robots, 13, 207–222.
Grady, D. K., Bekris, K. E., & Kavraki, L. E. (2011). Asynchronous distributed motion planning with safety guarantees under second-order dynamics. In Algorithmic foundations of robotics IX (pp. 53–70). Berlin/Heidelberg: Springer.
Hauser, K. (2010). Adaptive time stepping in real-time motion planning. In Workshop on the algorithmic foundations of robotics.
Hauser, K., & Ng-Thow-Hing, V. (2010). Fast smoothing of manipulator trajectories using optimal bounded-acceleration shortcuts. In Proc. IEEE int. conference on robotics and automation (ICRA), Anchorage, USA, 2010.
Hsu, D., Kindel, R., Latombe, J.-C., & Rock, S. (2002). Kinodynamic motion planning amidst moving obstacles. The International Journal of Robotics Research, 21(3), 233–255.
Kallmann, M., & Mataric, M. (2004). Motion planning using dynamic roadmaps. In IEEE intl. conf. on robotics and automation (ICRA), April 2004.
LaValle, S., & Kuffner, J. (1999). Randomized kinodynamic planning. In Proc. IEEE intl. conf. on robotics and automation (pp. 473–479).
Likhachev, M., Ferguson, D., Gordon, G., Stentz, A., & Thrun, S. (2005). Anytime dynamic a*: An anytime, replanning algorithm. In Proceedings of the international conference on automated planning and scheduling (ICAPS, 2005).
Mayne, D. Q., Rawlings, J. B., Rao, C. V., & Scokaert, P. O. M. (2000). Constrained model predictive control: Stability and optimality. Automatica, 36, 789–814.
Metcalfe, R. M., & Boggs, D. R. (1976). Ethernet: distributed packet switching for local computer networks. Communications of the ACM, 19, 395–404.
Musliner, D. J., Durfee, E. H., & Shin, K. G. (1993). Circa: a cooperative intelligent real-time control architecture. IEEE Transactions on Systems, Man, and Cybernetics, 23, 1561–1574.
Pan, J., Lauterbach, C., & Manocha, D. (2010). g-planner: Real-time motion planning and global navigation using GPUs. In AAAI conf. on artificial intelligence.
Petti, S., & Fraichard, T. (2005). Safe motion planning in dynamic environments. In IEEE international conference on intelligent robots and systems (IROS) (pp. 3726–3731).
Ross, I., Gong, Q., Fahroo, F., & Kang, W. (2006). Practical stabilization through real-time optimal control. In American control conference (p. 6), June 2006.
Sánchez, G., & Latombe, J.-C. (2002). On delaying collision checking in PRM planning: Application to multi-robot coordination. The International Journal of Robotics Research, 21(1), 5–26.
Stachniss, C., Beeson, P., Hähnel, D., Bosse, M., Leonard, J., Steder, B., Kümmerle, R., Dornhege, C., Ruhnke, M., Grisetti, G., & Kleiner, A. (2011). Laser-based slam datasets and benchmarks.
Stachniss, C., & Burgard, W. (2002). An integrated approach to goal-directed obstacle avoidance under dynamic constraints for dynamic environments. In IEEE-RSJ int. conf. on intelligent robots and systems (IROS) (pp. 508–513).
Stentz, A. (1995). The focussed d* algorithm for real-time replanning. In Proceedings of the international joint conference on artificial intelligence (IJCAI).
van den Berg, J., Ferguson, D., & Kuffner, J. (2006). Anytime path planning and replanning in dynamic environments. In Proceedings of the IEEE international conference on robotics and automation (ICRA) (pp. 2366–2371), May 2006.
van den Berg, J., & Overmars, M. (2005). Roadmap-based motion planning in dynamic environments. IEEE Transactions on Robotics, 21(5), 885–897.
You, E., & Hauser, K. (2011). Assisted teleoperation strategies for aggressively controlling a robot arm with 2d input. In Proc. robotics: science and systems, Los Angeles, USA, July 2011.
Zucker, M., Kuffner, J., & Branicky, M. (2007). Multipartite rrts for rapid replanning in dynamic environments. In Proc. IEEE int. conf. robotics and automation, April 2007.
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
Cite this article
Hauser, K. On responsiveness, safety, and completeness in real-time motion planning. Auton Robot 32, 35–48 (2012). https://doi.org/10.1007/s10514-011-9254-z
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10514-011-9254-z