Asynchronous Distributed Motion Planning with Safety Guarantees under Second-Order Dynamics

  • Devin K. Grady
  • Kostas E. Bekris
  • Lydia E. Kavraki
Part of the Springer Tracts in Advanced Robotics book series (STAR, volume 68)


As robots become more versatile, they are increasingly found to operate together in the same environment where they must coordinate their motion in a distributed manner. Such operation does not present problems if the motion is quasi-static and collisions can be easily avoided. However, when the robots follow second-order dynamics, the problem becomes challenging even for a known environment. The setup in this work considers that each robot replans its own trajectory for the next replanning cycle. The planning process must guarantee the robot’s safety by ensuring collision-free paths for the considered period and by not bringing the robot to states where collisions cannot be avoided in the future. This problem can be addressed through communication among the robots, but it becomes complicated when the replanning cycles of the different robots are not synchronized and the robots make planning decisions at different time instants. This paper shows how to guarantee the safe operation of multiple communicating second-order vehicles, whose replanning cycles do not coincide, through an asynchronous, distributed motion planning framework. The method is evaluated through simulations, where each robot is simulated on a different processor and communicates with its neighbors through message passing. The simulations confirm that the approach provides safety in scenarios with up to 48 robots with second-order dynamics in environments with obstacles, where collisions occur often without a safety framework.


Motion Planning Collision Avoidance Contingency Plan Static Obstacle Planning Cycle 
These keywords were added by machine and not by the authors. This process is experimental and the keywords may be updated as the learning algorithm improves.


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. 1.
    Alami, R., Simeon, T., Krishna, K.M.: On the influence of sensor capacities and environment dynamics onto collision-free motion plans. In: IEEE/RSJ IROS, Lausanne, CH (2002)Google Scholar
  2. 2.
    Bekris, K.E., Kavraki, L.E.: Greedy but safe replanning under kinodynamic constraints. In: IEEE ICRA, Rome, Italy (2007)Google Scholar
  3. 3.
    Bekris, K.E., Tsianos, K., Kavraki, L.E.: Safe and distributed kinodynamic replanning for vehicular networks. Mobile Networks and Applications 14(3), 292–308 (2009)CrossRefGoogle Scholar
  4. 4.
    Van den Berg, J., Lin, M., Manocha, D.: Reciprocal velocity obstacles for real-time multi-agent navigation. In: Proc. of the IEEE Int. Conf. on Robotics and Automation (ICRA) (2008) Google Scholar
  5. 5.
    Bruce, J., Veloso, M.: Real-time multi-robot motion planning with safe dynamics. In: Schultz, A., Parker, L., Schneider, F. (eds.) Intern. Workshop on Multi-Robot Systems (2003)Google Scholar
  6. 6.
    Chan, N., Kuffner, J.J., Zucker, M.: Improved motion planning speed and safety using regions of inevitable collision. In: 17th CISM-IFToMM RoManSy (2008)Google Scholar
  7. 7.
    Clark, C., Rock, S., Latombe, J.C.: Motion planning for multi-robot systems using dynamic robot networks. In: IEEE ICRA, Taipei, Taiwan (2003)Google Scholar
  8. 8.
    Dimarogonas, D.V., Kyriakopoulos, K.J.: Decentralized Navigation Functions for Multiple Robotic Agents. Intelligent and Robotic Systems 48(3), 411–433 (2007)CrossRefGoogle Scholar
  9. 9.
    Erdmann, M., Lozano-Perez, T.: On multiple moving objects. In: ICRA, pp. 1419–1424 (1986)Google Scholar
  10. 10.
    Fiorini, P., Shiller, Z.: Motion planning in dynamic environments using velocity obstacles. Int. Journal of Robotics Research 17(7) (1998)Google Scholar
  11. 11.
    Fox, D., Burgard, W., Thrun, S.: The dynamic window approach to collision avoidance. IEEE Robotics and Automation Magazine 4(1) (1997)Google Scholar
  12. 12.
    Fraichard, T.: A short paper about motion safety. In: IEEE ICRA, Rome, Italy (2007)Google Scholar
  13. 13.
    Fraichard, T., Asama, H.: Inevitable collision states: A step towards safer robots? In: Advanced Robotics, pp. 1001–1024 (2004)Google Scholar
  14. 14.
    Frazzoli, E., Dahleh, M., Feron, E.: Real-time motion planning for agile autonomous vehicles. AIAA Journal of Guidance, Control and Dynamics 25(1), 116–129 (2002)CrossRefGoogle Scholar
  15. 15.
    Hsu, D., Kindel, R., Latombe, J.C., Rock, S.: Randomized kinodynamic motion planning with moving obstacles. IJRR 21(3), 233–255 (2002)Google Scholar
  16. 16.
    Kalisiak, M., Van de Panne, M.: Faster motion planning using learned local viability models. In: Proc. of the IEEE Int. Conf. on Robotics and Automation, Roma, Italy (2007)Google Scholar
  17. 17.
    Lalish, E., Morgansen, K.A.: Decentralized reactive collision avoidance for multivehicle systems. In: IEEE Conference on Decision and Control (2008)Google Scholar
  18. 18.
    Lamiraux, F., Bonnafous, D., Lefebvre, O.: Reactive path deformation for nonholonomic mobile robots. IEEE Transactions on Robotics 20, 967–977 (2004)CrossRefGoogle Scholar
  19. 19.
    Laumond, J.P. (ed.): Robot Motion Planning and Control. Lectures Notes in Control and Information Sciences, vol. 229. Springer, Heidelberg (1998)Google Scholar
  20. 20.
    LaValle, S.M., Kuffner, J.J.: Randomized kinodynamic planning. IJRR 20(5), 378–400 (2001)Google Scholar
  21. 21.
    Martinez-Gomez, L., Fraichard, T.: Collision avoidance in dynamic environments: An ics-based solution and its comparative evaluation. In: IEEE ICRA, Kobe, Japan (2009)Google Scholar
  22. 22.
    Peng, J., Akella, S.: Coordinating multiple robots with kinodynamic constraints along specified paths. Int. Journal of Robotics Research 24(4), 295–310 (2005)CrossRefGoogle Scholar
  23. 23.
    Pivtoraiko, M., Knepper, R.A., Kelly, A.: Differentially constrained mobile robot motion planning in state lattices. Journal of Field Robotics 26, 308–333 (2009)CrossRefGoogle Scholar
  24. 24.
    Reif, J., Sharir, M.: Motion planning in the presence of moving obstacles. In: Proc. of the IEEE Int. Symp. on Foundations of Computer Science, Portland, OR (1985)Google Scholar
  25. 25.
    Vatcha, R., Xiao, J.: Perceived CT-Space for motion planning in unknown and unpredictable environments. In: Workshop on Algorithmic Foundations of Robotics, Mexico (2008)Google Scholar
  26. 26.
    Wikman, M.S., Branicky, M., Newman, W.S.: Reflexive collision avoidance: A generalized approach. In: Proc. of the IEEE Int. Conf. on Robotics and Automation (1993)Google Scholar
  27. 27.
    Yang, Y., Brock, O.: Elastic roadmaps: Globally task-consistent motion for autonomous mobile manipulation in dynamic environments. In: Robotics: Science and Systems II (2006)Google Scholar

Copyright information

© Springer-Verlag Berlin Heidelberg 2010

Authors and Affiliations

  • Devin K. Grady
    • 1
  • Kostas E. Bekris
    • 2
  • Lydia E. Kavraki
    • 1
  1. 1.Computer ScienceRice Univ.Houston
  2. 2.Computer Science and EngineeringUniv. of Nevada RenoReno

Personalised recommendations