Planning of multiple robot trajectories in distinctive topologies

This contribution presents a novel approach for efficient online planning of topologically distinctive mobile robot trajectories. Trajectory optimization deforms an initial coarse path drafted by a global planner with respect to robot motion related objectives and constraints. The primary objective is to reach a goal state in minimal time on a collision free path that adheres to the kinematic and dynamic constraints of the mobile robot. Conventional local planners get often stuck in a local optimal trajectory as they are unable to transit across obstacles. Our approach seeks the globally optimal trajectory as it maintains and optimizes a subset of admissible candidate trajectories of distinctive topologies in parallel. In case of dynamic environments the planner switches to the current globally optimal trajectory among the candidate set. The online trajectory planning with timed elastic bands is tightly integrated with the robot motion feedback control. The comparative analysis with conventional local planners confirms the advantages of maintaining distinctive topologies to circumnavigate dynamic obstacles.

[1]  Thierry Fraichard,et al.  Reactive Trajectory Deformation to Navigate Dynamic Environments , 2008, EUROS.

[2]  Sean Quinlan.  Real-time modification of collision-free paths , 1994 .

[3]  Florian T. Pokorny,et al.  Multiscale Topological Trajectory Classification with Persistent Homology , 2014, Robotics: Science and Systems.

[4]  Torsten Bertram,et al.  Trajectory modification considering dynamic constraints of autonomous robots , 2012, ROBOTIK.

[5]  Torsten Bertram,et al.  Efficient trajectory optimization using a sparse model , 2013, 2013 European Conference on Mobile Robots.

[6]  Subhrajit Bhattacharya,et al.  Topological and geometric techniques in graph search-based robot planning , 2012 .

[7]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[8]  Wolfram Burgard,et al.  Improved non-linear spline fitting for teaching trajectories to mobile robots , 2012, 2012 IEEE International Conference on Robotics and Automation.

[9]  Siddhartha S. Srinivasa,et al.  CHOMP: Gradient optimization techniques for efficient motion planning , 2009, 2009 IEEE International Conference on Robotics and Automation.

[10]  Stefan Schaal,et al.  STOMP: Stochastic trajectory optimization for motion planning , 2011, 2011 IEEE International Conference on Robotics and Automation.

[11]  Subhrajit Bhattacharya,et al.  Search-Based Path Planning with Homotopy Class Constraints in 3D , 2010, AAAI.

[12]  Wolfram Burgard,et al.  Online generation of homotopically distinct navigation paths , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Wolfram Burgard,et al.  The dynamic window approach to collision avoidance , 1997, IEEE Robotics Autom. Mag..

[14]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[15]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[16]  Siddhartha S. Srinivasa,et al.  Toward a deeper understanding of motion alternatives via an equivalence relation on local paths , 2012, Int. J. Robotics Res..

[17]  Thierry Siméon,et al.  Path Deformation Roadmaps: Compact Graphs with Useful Cycles for Motion Planning , 2008, Int. J. Robotics Res..

[18]  Andreas Krause,et al.  Unfreezing the robot: Navigation in dense, interacting crowds , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Didier Wolf,et al.  Capture of homotopy classes with probabilistic road map , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Wolfram Burgard,et al.  Kinodynamic motion planning for mobile robots using splines , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.