Probabilistic Path Planning using Obstacle Trajectory Prediction

In this paper, we describe a novel approach for navigation of a robot in a dynamic environment by exploiting the benefits of time series analysis of Long Short Term Memory (LSTM) architectures on obstacle trajectories. Most path planning algorithms consider the instantaneous position of the obstacles while generating the path, resulting in frequent re-planning and extended traversal time. However, moving obstacles more often than not tend to follow certain motion patterns in real life scenarios such as the motion of people on roads, building lobbies, shops, etc. In our algorithm, LSTM-based Dynamic Rapidly-exploring Random Trees star (LD-RRT*), obstacle trajectories are treated as sequences where their future position estimates are incorporated in the state validity checker of planning algorithms to generate an optimal path. Taking the future obstacle motion into account reduces the total traversal time and the frequency of re-planning. We propose the use of an LSTM model for future trajectory prediction and an extension of Rapidly-exploring Random Trees for path planning. Comparisons with other state of the art planners show the effectiveness of our algorithm.

[1]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[2]  Maxim Likhachev,et al.  SIPP: Safe interval path planning for dynamic environments , 2011, 2011 IEEE International Conference on Robotics and Automation.

[3]  Sebastian Thrun,et al.  Path Planning for Autonomous Driving in Unknown Environments , 2008, ISER.

[4]  Christian Laugier,et al.  Probabilistic navigation in dynamic environment using Rapidly-exploring Random Trees and Gaussian processes , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Panagiotis Tsiotras,et al.  Use of relaxation methods in sampling-based algorithms for optimal motion planning , 2013, 2013 IEEE International Conference on Robotics and Automation.

[6]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[8]  Dan Halperin,et al.  Asymptotically near-optimal RRT for fast, high-quality, motion planning , 2013, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

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

[11]  Christian Laugier,et al.  Bayesian Occupancy Filtering for Multitarget Tracking: An Automotive Application , 2006, Int. J. Robotics Res..

[12]  Valiallah Monajjemi,et al.  grSim - RoboCup Small Size Robot Soccer Simulator , 2011, RoboCup.

[13]  Carl E. Rasmussen,et al.  Gaussian processes for machine learning , 2005, Adaptive computation and machine learning.

[14]  Christian Laugier,et al.  Dynamic Obstacle Avoidance in uncertain environment combining PVOs and Occupancy Grid , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[16]  J. How,et al.  Chance Constrained RRT for Probabilistic Robustness to Environmental Uncertainty , 2010 .

[17]  Barbara Majecka,et al.  Statistical models of pedestrian behaviour in the Forum , 2009 .

[18]  Silvio Savarese,et al.  Social LSTM: Human Trajectory Prediction in Crowded Spaces , 2016, 2016 IEEE Conference on Computer Vision and Pattern Recognition (CVPR).

[19]  Jonathan P. How,et al.  Probabilistically safe motion planning to avoid dynamic obstacles with uncertain motion patterns , 2013, Auton. Robots.

[20]  Yu Zhu,et al.  Real-time generation of trapezoidal velocity profile for minimum energy consumption and zero residual vibration in servomotor systems , 2016, 2016 American Control Conference (ACC).

[21]  Jürgen Schmidhuber,et al.  Long Short-Term Memory , 1997, Neural Computation.

[22]  Byung Kook Kim,et al.  Minimum-Energy Motion Planning for Differential-Driven Wheeled Mobile Robots , 2008 .

[23]  Emilio Frazzoli,et al.  RRTX: Real-Time Motion Planning/Replanning for Environments with Unpredictable Obstacles , 2014, WAFR.

[24]  E. Feron,et al.  Real-time motion planning for agile autonomous vehicles , 2000, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[25]  Alex Graves,et al.  Generating Sequences With Recurrent Neural Networks , 2013, ArXiv.

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

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