Skip to main content
SpringerLink
Log in

Safe and Distributed Kinodynamic Replanning for Vehicular Networks

  • Published:
Mobile Networks and Applications Aims and scope Submit manuscript

Abstract

This work deals with the problem of planning collision-free motions for multiple communicating vehicles that operate in the same, partially-observable environment in real-time. A challenging aspect of this problem is how to utilize communication so that vehicles do not reach states from which collisions cannot be avoided due to second-order motion constraints. This paper initially shows how it is possible to provide theoretical safety guarantees with a priority-based coordination scheme. Safety means avoiding collisions with obstacles and between vehicles. This notion is also extended to include the retainment of a communication network when the vehicles operate as a networked team. The paper then progresses to extend this safety framework into a fully distributed communication protocol for real-time planning. The proposed algorithm integrates sampling-based motion planners with message-passing protocols for distributed constraint optimization. Each vehicle uses the motion planner to generate candidate feasible trajectories and the message-passing protocol for selecting a safe and compatible trajectory. The existence of such trajectories is guaranteed by the overall approach. The theoretical results have also been experimentally confirmed with a distributed simulator built on a cluster of processors and using applications such as coordinated exploration. Furthermore, experiments show that the distributed protocol has better scalability properties when compared against the priority-based scheme.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Log in via an institution

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Institutional subscriptions

Fig. 1
Fig. 2
Fig. 3
Fig. 4
Fig. 5
Fig. 6
Fig. 7
Fig. 8
Fig. 9
Fig. 10
Fig. 11
Fig. 12

Similar content being viewed by others

References

  1. Yang X, Liu L, Vaidya NH, Zhao F (2004) A vehicle-to-vehicle communication protocol for cooperative collision warning. In: MOBIQUITOUS-04, Boston, 22–26 August 2004

  2. DSRC (2008) DSRCD Home. http://www.leearmstrong.com/dsrc/dsrchomeset.htm

  3. Clarc C, Rock S, Latombe J-C (2003) Dynamic networks for motion planning in multi-robot space systems. In: Intl. symp. of artificial intelligence, robotics and automation in space, Kobe, 20–24 July 2003

  4. Clark MC, Bretl T, Rock S (2002) Applying kinodynamic randomized motion planning with a dynamic priority system to multi-robot space systems. In: Aerospace conference, Toulouse, 16–19 June 2002

  5. Murray RM (2007) Recent research in cooperative control of multi-vehicle systems. ASME J Dyn Syst Meas Control 129(5):571–583

    Article  Google Scholar 

  6. Ogren P, Fiorelli E, Leonard NE (2004) Cooperative control of mobile sensor networks: adaptive gradient climbing in distributed environments. IEEE Trans Automat Contr 49(8):1292–1302

    Article  MathSciNet  Google Scholar 

  7. Olfati-Saber R (2006) Flocking for multi-agent dynamic systems: algorithms and theory. IEEE Trans Automat Contr 51(3):401–420

    Article  MathSciNet  Google Scholar 

  8. Pereira GAS, Das AK, Kumar V, Campos MFM (2003) Decentralized motion planning for multiple robots subject to sesnsing and communication constraints. In: Work. on multi-robot systems

  9. Tanner HG, Pappas GJ, Kumar V (2004) Leader-to-formation stability. IEEE TRA 20(3):443–455

    Google Scholar 

  10. Egerstedt M, Hu X, Stotsky A (2001) Control of mobile platforms using a virtual vehicle approach. IEEE Trans Automat Contr 46(4):1777–1782, November

    Article  MATH  MathSciNet  Google Scholar 

  11. Pallotino L, Scordio VG, Frazzoli E, Bicchi A (2006) Decentralized and scalable conflict resolution strategy for multi-agent systems. In: Int. symp. on mathematical theory of networks and systems, Kyoto, 24–28 July 2006

  12. Dimarogonas DV, Kyriakopoulos KJ, Theodorakatos D (2006) Totally distributed motion control of sphere world multi-agent systems using decentralized navigation functions. In: IEEE Int Conf Robot Autom

  13. Loizou S, Dimarogonas D, Kyriakopoulos K (2004) Decentralized feedback stabilization of multiple nonholonomic agents. In: IEEE Int Conf Robot Autom, vol 3, pp 3012–3017

  14. LaValle S (2006) Planning algorithms. Cambridge University Press, Cambridge

    MATH  Google Scholar 

  15. Kavraki LE, Svestka P, Latombe J-C, Overmars M (1996) Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE TRA 12(4):566–580

    Google Scholar 

  16. Choset H, Lynch KM, Hutchinson S, Kantor G, Burgard W, Kavraki LE, Thrun S (2005) Principles of robot motion: theory, algorithms, and implementations. MIT, Boston

    MATH  Google Scholar 

  17. Donald BR, Xavier PG, Canny JF, Reif JH (1993) Kinodynamic motion planning. J ACM 40(5):1048–1066

    Article  MATH  MathSciNet  Google Scholar 

  18. LaValle SM, Kuffner JJ (2001) Randomized kinodynamic planning. IJRR 20(5):378–400

    Google Scholar 

  19. Ladd AM, Kavraki LE (2005) Motion planning in the presence of drift, underactuation and discrete system changes. In: Robot Sci Syst I, Cambridge, June 2005

  20. Bekris KE, Kavraki LE (2007) Greedy but safe replanning under kinodynamic constraints. In: IEEE Int Conf Robot Autom, Rome, April 2007

  21. Hsu D, Kindel R, Latombe J-C, Rock S (2002) Randomized kinodynamic motion planning with moving obstacles. IJRR 21(3):233–255

    Google Scholar 

  22. Bruce J, Veloso M (2006) Safe multi-robot navigation within dynamic constraints. Proc IEEE 94:1398–1411

    Article  Google Scholar 

  23. Ferguson D, Kalra N, Stentz A (2006) Replanning with RRTs. In: IEEE Int Conf Robot Autom

  24. Zucker M, Kuffner J, Branicky M (2007) Multipartite RRTs for rapid replanning in dynamic environments. In: IEEE int. conf. on robotics and automation, ICRA-07

  25. Gayle R, Klinger KR, Xavier PG (2007) Lazy reconfiguration forest: an approach for planning with multiple tasks in dynamic environments. In: IEEE Int Conf Robot Autom, Rome, 10–14 April 2007, pp 1316–1323

  26. Berg Jvd, Ferguson D, Kuffner J (2006) Anytime path planning and replanning in dynamic environments. In: IEEE Int Conf Robot Autom, May

  27. Kallman M, Mataric M (2004) Motion planning using dynamic roadmaps. In: IEEE Int Conf Robot Autom-04, vol 5

  28. Fraichard T, Asama H (2004) Inevitable collision states—a step towards safer robots? Adv Robot 18(10):1001–1024

    Article  Google Scholar 

  29. Petti S, Fraichard T (2005) Partial motion planning framework for reactive planning within dynamic environments. In: IEEE Int Conf Robot Autom, Barcelona, September 2005

  30. Frazzoli E, Dahleh MA, Feron E (2002) Real-time motion planning for agile autonomous vehicles. AIAA J Guid Control 25(1):116–129

    Article  Google Scholar 

  31. Sanchez G, Latombe J-C (2003) A single-query bi-directional probabilistic roadmap planner with lazy collision checking. In: Int Symp Rob Res, pp 404–417

  32. Bennewitz M, Burgard W, Thrun S (2002) Finding and optimizing solvable priority schemes for decoupled path planning for teams of mobile robots. Robot Auton Syst 41(2):89–99

    Article  Google Scholar 

  33. Saha M, Isto P (2006) Multi-robot motion planning by incremental coordination. In: Int Conf Intell Robot Syst

  34. Bekris KE, Tsianos KI, Kavraki LE (2007) A decentralized planner that guarantees the safety of communicating vehicles with complex dynamics that replan online. In: IEEE/RSJ Int Conf Intell Robot Syst (IROS 2007), 29 Oct 2007–2 Nov 2007, pp 3784–3790

  35. Yokoo M, Hirayama K (2000) Algorithms for distributed constraint satisfaction: a review. Auton Agents Multi-Agent Syst 3(2):189–212

    Article  Google Scholar 

  36. Modi PJ, Shen W-M, Tambe M, Yokoo M (2005) An asynchronous complete method for distributed constraint optimization. Artif Intell J 161(1–2):149–180

    Article  MATH  MathSciNet  Google Scholar 

  37. Guestrin C, Koller D, Parr R (2002) Multiagent planning with factored MDPs. In: NIPS-14. MIT, Cambridge

  38. Gerkey BP, Mataric MJ (2002) Sold!: auction methods for multi-robot coordination. IEEE TRA 18(5):758–786

    Google Scholar 

  39. Diass MB, Zlot R, Kalra N, Stentz A (2006) Market-based multirobot coordination: a survey and analysis. Proc IEEE 94(7):1257–1270

    Article  Google Scholar 

  40. Pearl J (1988) Probabilistic reasoning in intelligent systems. Morgan Kaufmann, San Francisco

    Google Scholar 

  41. Kok JR, Vlassis N (2006) Collaborative multiagent reinforcement learning by payoff propagation. J Mach Learn Res 7:1789–1828

    MathSciNet  Google Scholar 

  42. Plarre K, Kumar PR (2004) Extended message passing algorithm for inference in loopy Gaussian graphical models. Ad Hoc Netw 2:153–169

    Article  Google Scholar 

  43. Bekris KE, Tsianos KI, Kavraki LE (2007) A distributed protocol for safe real-time planning of communicating vehicles with second-order dynamics. In: First Int Conf Robot Commun Coord

  44. Ladd AM, Kavraki LE (2005) Fast tree-based exploration of state space for robots with dynamics. In: Workshop Algorithmic Found Robot, pp 297–312

  45. Hsieh MA, Kumar V, Taylor CJ (2004) Constructing radio signal strength maps with multiple robots. In: IEEE inter. conference on robotics and automation, vol 4, New Orleans, April 2004, pp 4184–4189

  46. Singh G, Bernstein AJ (1995) A highly asynchronous minimum spanning tree protocol. Distrib Comput 8(3):151–161

    Article  Google Scholar 

  47. Radia P (1985) An algorithm for distributed computation of a spanning tree in an extended LAN. ACM SIGCOMM Comput Commun Rev 15(4):44–53

    Article  Google Scholar 

Download references

Acknowledgements

Work on this paper has been supported in part by NSF 0308237, 0615328 and 0713623. The computational experiments were run on equipment obtained by CNS 0454333, and CNS 0421109 in partnership with Rice University, AMD and Cray. The authors would like to thank the anonymous reviewers and the organizing committee of ROBOCOMM 2007 for their comments and their invitation to MONE. Furthermore, the comments by the MONE reviewing and editorial team were helpful in further improving the quality of the final manuscript.

Author information

Authors and Affiliations

  1. Computer Science Department, Rice University, Houston, TX, 77005, USA

    Kostas E. Bekris, Konstantinos I. Tsianos & Lydia E. Kavraki

Authors
  1. Kostas E. Bekris
    View author publications

    You can also search for this author in PubMed Google Scholar

  2. Konstantinos I. Tsianos
    View author publications

    You can also search for this author in PubMed Google Scholar

  3. Lydia E. Kavraki
    View author publications

    You can also search for this author in PubMed Google Scholar

Corresponding author

Correspondence to Lydia E. Kavraki.

Additional information

Part of the material presented in this paper has appeared in two conference publications: “A Decentralized Planner that Guarantees the Safety of Communicating Vehicles with Complex Dynamics that Replan Online” at IROS 2007 and “A Distributed Protocol for Safe Real-Time Planning of Communicating Vehicles with Second-Order Dynamics” at ROBOCOMM 2007.

Rights and permissions

Reprints and permissions

About this article

Cite this article

Bekris, K.E., Tsianos, K.I. & Kavraki, L.E. Safe and Distributed Kinodynamic Replanning for Vehicular Networks. Mobile Netw Appl 14, 292–308 (2009). https://doi.org/10.1007/s11036-009-0152-y

Download citation

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s11036-009-0152-y

Keywords

Search

Navigation