Kinodynamic motion planning: connecting exploration trees using trajectory optimization Methods

Motion planning for complex dynamic systems as well as kinodynamic motion planning are still problems difficult to solve in their generic formulation. For systems for which no steering method is known, the only existing algorithms consist in building an exploration tree in the configuration space by exploring the input space of the system. The main drawback of this type of methods is that they never reach exactly the goal but stops the search when a small neighborhood of the goal has been reached. If the neighborhood is small, the exploration method needs to produce a lot of nodes. In this paper, we propose a solution to cope with this complexity issue. We run a tree exploration method with a big neighborhood and then we locally modify the trajectory in order to make it reach exactly the goal. Our solution is based on a trajectory optimization method we have developed earlier in a mobile robot context and that we have adapted for the problem raised here. The method is generic and can be applied to any dynamic system. A few experimental results are given at the end of the paper.

[1]  Bruce Randall Donald,et al.  Kinodynamic motion planning , 1993, JACM.

[2]  J. Laumond,et al.  Multi-Level Path Planning for Nonholonomic Robots using Semi-Holonomic Subsystems , 1996 .

[3]  Thierry Fraichard,et al.  Continuous-curvature path planning for car-like vehicles , 1997, Proceedings of the 1997 IEEE/RSJ International Conference on Intelligent Robot and Systems. Innovative Robotics for Real-World Applications. IROS '97.

[4]  Mark H. Overmars,et al.  Multilevel Path Planning for Nonholonomic Robots Using Semiholonomic Subsystems , 1998, Int. J. Robotics Res..

[5]  Florent Lamiraux,et al.  Motion planning and control for Hilare pulling a trailer , 1999, IEEE Trans. Robotics Autom..

[6]  P. Rouchon,et al.  Computing the flat outputs of Engel differential systems: the case study of the bi-steerable car , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[7]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[8]  Florent Lamiraux,et al.  Reactive trajectory deformation for nonholonomic systems: application to mobile robots , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[9]  J. Laumond,et al.  Trailer-truck trajectory optimization for Airbus A 380 component transportation , 2003 .

[10]  Emilio Frazzoli,et al.  Exploiting group symmetries to improve precision in kinodynamic and nonholonomic planning , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[11]  Jean-Claude Latombe,et al.  Nonholonomic multibody mobile robots: Controllability and motion planning in the presence of obstacles , 2005, Algorithmica.

[12]  Florent Lamiraux,et al.  Trailer truck trajectory optimization: the transportation of components for the Airbus A380 , 2005, IEEE Robotics & Automation Magazine.