An improved RRT-based motion planner for autonomous vehicle in cluttered environments

In this paper, we present an improved RRT-based motion planner for autonomous vehicles to effectively navigate in cluttered environments with narrow passages. The planner first presents X-test that can identify passable narrow passages, and then perform an efficient obstacles-based extension operation within passable narrow passages. In order to generate a smooth trajectory for the vehicle to execute, a post-process algorithm with trajectory optimization is proposed. For the purpose of demonstrate benefits of our method, the proposed motion planner is implemented and tested on a real autonomous vehicle in cluttered scenarios with narrow passages. Experimental results show that our planner achieves up to 13.8 times and 7.6 times performance improvements over a basic RRT planner and a Bi-RRT planner respectively. Moreover, the resulting path of our planner is more smooth and reasonable.

[1]  Nancy M. Amato,et al.  An obstacle-based rapidly-exploring random tree , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[2]  Jun Wang,et al.  Development of ‘Intelligent Pioneer’ unmanned vehicle , 2012, 2012 IEEE Intelligent Vehicles Symposium.

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

[4]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[5]  Steven M. LaValle,et al.  Incrementally reducing dispersion by increasing Voronoi bias in RRTs , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[6]  Dinesh Manocha,et al.  Retraction-based RRT planner for articulated models , 2010, 2010 IEEE International Conference on Robotics and Automation.

[7]  Yoram Koren,et al.  Potential field methods and their inherent limitations for mobile robot navigation , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[8]  Sebastian Thrun,et al.  Anytime Dynamic A*: An Anytime, Replanning Algorithm , 2005, ICAPS.

[9]  Thierry Siméon,et al.  Dynamic-Domain RRTs: Efficient Exploration by Controlling the Sampling Domain , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[10]  D. Dolgov.  Practical Search Techniques in Path Planning for Autonomous Driving , 2008 .

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

[12]  Dinesh Manocha,et al.  Collision-free and smooth trajectory computation in cluttered environments , 2012, Int. J. Robotics Res..

[13]  Junghwan Lee,et al.  SR-RRT: Selective retraction-based RRT planner , 2012, 2012 IEEE International Conference on Robotics and Automation.

[14]  Jonathan P. How,et al.  Motion planning for urban driving using RRT , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  David Hsu,et al.  The bridge test for sampling narrow passages with probabilistic roadmap planners , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[16]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.

[17]  Dinesh Manocha,et al.  An efficient retraction-based RRT planner , 2008, 2008 IEEE International Conference on Robotics and Automation.

[18]  Thierry Siméon,et al.  Visibility-based probabilistic roadmaps for motion planning , 2000, Adv. Robotics.

[19]  J. How,et al.  Improving the Efficiency of Rapidly-exploring Random Trees Using a Potential Function Planner , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[20]  O. Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[21]  Yu-Chi Chang,et al.  Finding Narrow Passages with Probabilistic Roadmaps: The Small-Step Retraction Method , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.