An Efficient RRT-Based Framework for Planning Short and Smooth Wheeled Robot Motion Under Kinodynamic Constraints

This article presents a framework that extends a rapidly exploring random tree (RRT) algorithm to plan the motion for a wheeled robot under kinodynamic constraints. Unlike previous RRT-based path planning algorithms that apply complex steer functions during a path sampling phase, this framework uses a straight line to connect a pair of sampled waypoints such that an obstacle-free path can be quickly found. This path is further pruned by the short-cutting algorithm. Under the kinodynamic constraints, we propose a motion-control law that is guided by a pose-based steer function for the robot to reach its destination in a short time. A path deformation strategy is presented that shifts the waypoint away from the collision point such that the trajectory can be generated without any collision. Simulation results demonstrate that the proposed framework needs less computation to generate a smoother trajectory with shorter length than its peers, and experimental results show that simulated trajectories of our controller are very close to real ones and the performance is better than that of a prior pose-based controller.

[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]  David González,et al.  A Review of Motion Planning Techniques for Automated Vehicles , 2016, IEEE Transactions on Intelligent Transportation Systems.

[3]  Johnathan Votion,et al.  Diversity-Based Cooperative Multivehicle Path Planning for Risk Management in Costmap Environments , 2019, IEEE Transactions on Industrial Electronics.

[4]  Gaurav S. Sukhatme,et al.  Gradient-Informed Path Smoothing for Wheeled Mobile Robots , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[5]  MengChu Zhou,et al.  A survey of multi-robot regular and adversarial patrolling , 2019, IEEE/CAA Journal of Automatica Sinica.

[6]  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).

[7]  A. Astolfl,et al.  Exponential Stabilization of a Wheeled Mobile Robot Via Discontinuous Control , 2007 .

[8]  Munther A. Dahleh,et al.  Maneuver-based motion planning for nonlinear systems with symmetries , 2005, IEEE Transactions on Robotics.

[9]  H. A. Varol,et al.  Rapidly-exploring random tree based memory efficient motion planning , 2013, 2013 IEEE International Conference on Mechatronics and Automation.

[10]  Sangwoo Moon,et al.  Spline-Based RRT Path Planner for Non-Holonomic Robots , 2013, Journal of Intelligent & Robotic Systems.

[11]  Denis Pomorski,et al.  GPS/IMU data fusion using multisensor Kalman filtering: introduction of contextual aspects , 2006, Inf. Fusion.

[12]  Byung Kook Kim,et al.  Time-Optimal Trajectory Planning Based on Dynamics for Differential-Wheeled Mobile Robots With a Geometric Corridor , 2017, IEEE Transactions on Industrial Electronics.

[13]  Kai Oliver Arras,et al.  A novel RRT extend function for efficient and smooth mobile robot motion planning , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Mário S. Alvim,et al.  Information-Driven Rapidly-Exploring Random Tree for Efficient Environment Exploration , 2018, J. Intell. Robotic Syst..

[15]  Emilio Frazzoli,et al.  Incremental Sampling-based Algorithms for Optimal Motion Planning , 2010, Robotics: Science and Systems.

[16]  Efe Camci,et al.  Learning motion primitives for planning swift maneuvers of quadrotor , 2019, Auton. Robots.

[17]  Mark H. Overmars,et al.  Creating High-quality Paths for Motion Planning , 2007, Int. J. Robotics Res..

[18]  Soon-Jo Chung,et al.  Motion primitives and 3D path planning for fast flight through a forest , 2015, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Long Chen,et al.  A Fast and Efficient Double-Tree RRT$^*$-Like Sampling-Based Planner Applying on Mobile Robotic Systems , 2018, IEEE/ASME Transactions on Mechatronics.

[20]  Van-Dung Hoang,et al.  A Simplified Solution to Motion Estimation Using an Omnidirectional Camera and a 2-D LRF Sensor , 2016, IEEE Transactions on Industrial Informatics.

[21]  Devin Connell,et al.  Extended rapidly exploring random tree–based dynamic path planning and replanning for mobile robots , 2018 .

[22]  Baris Akgün,et al.  Sampling heuristics for optimal motion planning in high dimensions , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Jing Yuan,et al.  Consistent Path Planning for On-Axle-Hitching Multisteering Trailer Systems , 2018, IEEE Transactions on Industrial Electronics.

[24]  Zhijun Li,et al.  Neural Network Approximation Based Near-Optimal Motion Planning With Kinodynamic Constraints Using RRT , 2018, IEEE Transactions on Industrial Electronics.

[25]  Wolfram Burgard,et al.  BI2RRT*: An efficient sampling-based path planning framework for task-constrained mobile manipulation , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[26]  Ming Cong,et al.  Episodic Memory-Based Robotic Planning Under Uncertainty , 2017, IEEE Transactions on Industrial Electronics.

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

[28]  Woojin Chung,et al.  Kinodynamic Planner Dual-Tree RRT (DT-RRT) for Two-Wheeled Mobile Robots Using the Rapidly Exploring Random Tree , 2015, IEEE Transactions on Industrial Electronics.

[29]  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.

[30]  Markus Hehn,et al.  A Computationally Efficient Motion Primitive for Quadrocopter Trajectory Generation , 2015, IEEE Transactions on Robotics.

[31]  M. G. Mohanan,et al.  A survey of robotic motion planning in dynamic environments , 2018, Robotics Auton. Syst..

[32]  Pierre Payeur,et al.  A Mode-Switching Motion Control System for Reactive Interaction and Surface Following Using Industrial Robots , 2018, IEEE/CAA Journal of Automatica Sinica.

[33]  Jie Chen,et al.  Curvature-constrained path elongation with expected length for Dubins vehicle , 2019, Autom..

[34]  Lydia E. Kavraki,et al.  Anytime solution optimization for sampling-based motion planning , 2013, 2013 IEEE International Conference on Robotics and Automation.

[35]  MengChu Zhou,et al.  Energy-Optimal Collision-Free Motion Planning for Multiaxis Motion Systems: An Alternating Quadratic Programming Approach , 2019, IEEE Transactions on Automation Science and Engineering.

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

[37]  Marco Pavone,et al.  Fast Marching Trees: A Fast Marching Sampling-Based Method for Optimal Motion Planning in Many Dimensions , 2013, ISRR.

[38]  Van-Dung Hoang,et al.  Motion Estimation Based on Two Corresponding Points and Angular Deviation Optimization , 2017, IEEE Transactions on Industrial Electronics.