Global Trajectory Generation for Nonholonomic Robots in Dynamic Environments

We consider the problem of generating global feasible trajectories for nonholonomic mobile robots in the presence of moving obstacles. The global trajectory is composed of regional path segments, which are parametric polynomials incorporating collision avoidance criteria. Collision avoidance with moving obstacles is achieved by changing parameters of the regional trajectories, and the collision avoidance parameters are solutions to a second-order inequality and are obtainable analytically. To have a smooth global trajectory, we also develop a smooth irregular curve method to generate continuous boundary conditions to connecting regional trajectories. Steering control laws are constructed by means of differential flatness. The proposed technique works in dynamic environments where a set of global way-points are available, and the velocities of the obstacles are obtainable real time. Simulation results show the effectiveness of the methods.

[1]  L. Shepp,et al.  OPTIMAL PATHS FOR A CAR THAT GOES BOTH FORWARDS AND BACKWARDS , 1990 .

[2]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[3]  Z. Qu,et al.  A New Performance-Based Motion Planner for Nonholonomic Mobile Robots , 2003 .

[4]  Winston Nelson,et al.  Continuous-curvature paths for autonomous vehicles , 1989, Proceedings, 1989 International Conference on Robotics and Automation.

[5]  S. Sastry,et al.  Trajectory generation for the N-trailer problem using Goursat normal form , 1993, Proceedings of 32nd IEEE Conference on Decision and Control.

[6]  Aurelio Piazzi,et al.  Quintic G2-splines for the iterative steering ofvision-based autonomous vehicles , 2002, IEEE Trans. Intell. Transp. Syst..

[7]  Paolo Fiorini,et al.  Motion Planning in Dynamic Environments Using Velocity Obstacles , 1998, Int. J. Robotics Res..

[8]  J. Sussmann,et al.  SHORTEST PATHS FOR THE REEDS-SHEPP CAR: A WORKED OUT EXAMPLE OF THE USE OF GEOMETRIC TECHNIQUES IN NONLINEAR OPTIMAL CONTROL. 1 , 1991 .

[9]  Jian Yang,et al.  An Optimal and Real-Time Solution to Parameterized Mobile Robot Trajectories in the Presence of Moving Obstacles , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[10]  S. Zucker,et al.  Toward Efficient Trajectory Planning: The Path-Velocity Decomposition , 1986 .

[11]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[12]  M. Fliess,et al.  Flatness and defect of non-linear systems: introductory theory and examples , 1995 .

[13]  Zhihua Qu,et al.  A new analytical solution to mobile robot trajectory generation in the presence of moving obstacles , 2004, IEEE Transactions on Robotics.

[14]  Tomás Lozano-Pérez,et al.  On multiple moving objects , 2005, Algorithmica.

[15]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

[16]  Yi Guo,et al.  A distributed and optimal motion planning approach for multiple mobile robots , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

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