An optimal sampling-based path planning under uncertainty based on linear quadratic regulator

The navigation of mobile robots is affected by noises from perceptual systems and positioning systems, as well as track deviations from control systems. Therefore, it is significant to ensure the stability of path planning in an uncertain environment. In this paper, an optimal samplingbased path planning method based on linear quadratic regulator is proposed. This method uses heuristic rapid-exploring random tree to generate paths which are executable and asymptotic optimal. Then, the priori distributions of the generated paths are calculated and evaluated through an uncertainty factor. The effectiveness of the proposed method is verified by simulation experiments in a variety of uncertain environments.

[1]  Leslie Pack Kaelbling,et al.  LQR-RRT*: Optimal sampling-based motion planning with automatically derived extension heuristics , 2012, 2012 IEEE International Conference on Robotics and Automation.

[2]  Wolfram Burgard,et al.  Coastal navigation-mobile robot navigation with uncertainty in dynamic environments , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[3]  P. Abbeel,et al.  LQG-MP: Optimized path planning for robots with motion uncertainty and imperfect state information , 2011 .

[4]  Weisheng Yan,et al.  Mutual Information-Based Multi-AUV Path Planning for Scalar Field Sampling Using Multidimensional RRT* , 2016, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[5]  Charles Richter,et al.  Learning to Plan for Visibility in Navigation of Unknown Environments , 2016, ISER.

[6]  Yasar Ayaz,et al.  RRT*-SMART: A Rapid Convergence Implementation of RRT* , 2013 .

[7]  Jianqiao Yu,et al.  UAV path planning using artificial potential field method updated by optimal control theory , 2016, Int. J. Syst. Sci..

[8]  Kam K. Leang,et al.  On-board model-based automatic collision avoidance: application in remotely-piloted unmanned aerial vehicles , 2017, Auton. Robots.

[9]  Jur P. van den Berg,et al.  Kinodynamic RRT*: Asymptotically optimal motion planning for robots with linear dynamics , 2013, 2013 IEEE International Conference on Robotics and Automation.

[10]  Sebastian Scherer,et al.  RRT*-AR: Sampling-based alternate routes planning with applications to autonomous emergency landing of a helicopter , 2013, 2013 IEEE International Conference on Robotics and Automation.

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

[12]  Ron Alterovitz,et al.  Stochastic Extended LQR for Optimization-Based Motion Planning Under Uncertainty , 2016, IEEE Trans Autom. Sci. Eng..

[13]  Jur P. van den Berg,et al.  Iterated LQR smoothing for locally-optimal feedback control of systems with non-linear dynamics and non-quadratic cost , 2014, 2014 American Control Conference.

[14]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..