Receding Horizon Control for Convergent Navigation of a Differential Drive Mobile Robot

A receding horizon control (RHC) algorithm for convergent navigation of a differential drive mobile robot is proposed. Its objective function utilizes a local-minima-free navigation function to measure the cost-to-goal over the robot trajectory. The navigation function is derived from the path-search algorithm over a discretized 2-D search space. The proposed RHC navigation algorithm includes a systematic procedure for the generation of feasible control sequences. The optimal value of the objective function is employed as a Lyapunov function to prove a finite-time convergence of the discrete-time nonlinear closed-loop system to the goal state. The developed RHC navigation algorithm inherits fast replanning capability from the $D$ * search algorithm, which is experimentally verified in changing indoor environments. The performance of the developed RHC navigation algorithm is compared with the state-of-the-art sample-based motion planning algorithm based on lattice graphs, which is combined with a trajectory tracking controller. The RHC navigation algorithm produces faster motion to the goal with significantly lower computational costs and it does not need any controller tuning to cope with diverse obstacle configurations.

[1]  Chao-Li Wang,et al.  Robust Stabilization of Nonholonomic Chained Form Systems with Uncertainties , 2011 .

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

[3]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .

[4]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[5]  LikhachevMaxim,et al.  Planning Long Dynamically Feasible Maneuvers for Autonomous Vehicles , 2009 .

[6]  F. Fontes.  Discontinuous feedbacks, discontinuous optimal controls, and continuous-time model predictive control , 2003 .

[7]  Ross A. Knepper,et al.  Optimal , Smooth , Nonholonomic Mobile Robot Motion Planning in State Lattices , 2007 .

[8]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1985, Autonomous Robot Vehicles.

[9]  Ahmed Benzerrouk,et al.  Mobile Robot Navigation in Cluttered Environment using Reactive Elliptic Trajectories , 2011 .

[10]  Ivan Petrovic,et al.  Two-way D* algorithm for path planning and replanning , 2011, Robotics Auton. Syst..

[11]  Wolfram Burgard,et al.  Efficient navigation for anyshape holonomic mobile robots in dynamic environments , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Herbert G. Tanner,et al.  Hybrid Potential Field Based Control of Differential Drive Mobile Robots , 2012, J. Intell. Robotic Syst..

[13]  S. LaValle,et al.  Motion Planning , 2008, Springer Handbook of Robotics.

[14]  Dimos V. Dimarogonas,et al.  Self-triggered Model Predictive Control for nonholonomic systems , 2013, 2013 European Control Conference (ECC).

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

[16]  Oliver Brock,et al.  Planning Long Dynamically-Feasible Maneuvers for Autonomous Vehicles , 2009 .

[17]  R. W. Brockett,et al.  Asymptotic stability and feedback stabilization , 1982 .

[18]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

[19]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[20]  Dongbing Gu,et al.  A stabilizing receding horizon regulator for nonholonomic mobile robots , 2005, IEEE Trans. Robotics.

[21]  Anthony Stentz.  Optimal and efficient path planning for partially-known environments , 1994 .

[22]  F. Kuhne,et al.  Point stabilization of mobile robots with nonlinear model predictive control , 2005, IEEE International Conference Mechatronics and Automation, 2005.

[23]  Petter Ögren,et al.  A convergent dynamic window approach to obstacle avoidance , 2005, IEEE Transactions on Robotics.

[24]  Herbert G. Tanner,et al.  Randomized Receding Horizon Navigation , 2010, IEEE Transactions on Automatic Control.

[25]  Hua Chen,et al.  Global Finite-time Stabilization for a Class of Nonholonomic Chained System with Input Saturation ⋆ , 2014 .

[26]  Graham C. Goodwin,et al.  Constrained Control and Estimation: an Optimization Approach , 2004, IEEE Transactions on Automatic Control.

[27]  Antonio Bicchi,et al.  Closed loop steering of unicycle like vehicles via Lyapunov techniques , 1995, IEEE Robotics Autom. Mag..

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

[29]  Steven M. LaValle,et al.  Simple and Efficient Algorithms for Computing Smooth, Collision-free Feedback Laws Over Given Cell Decompositions , 2009, Int. J. Robotics Res..

[30]  Emilio Frazzoli,et al.  Anytime Motion Planning using the RRT* , 2011, 2011 IEEE International Conference on Robotics and Automation.

[31]  Patricia Mellodge,et al.  Model Abstraction in Dynamical Systems: Application to Mobile Robot Control , 2008 .

[32]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[33]  Franz Aurenhammer,et al.  Handbook of Computational Geometry , 2000 .

[34]  David Q. Mayne,et al.  Constrained model predictive control: Stability and optimality , 2000, Autom..

[35]  Daniel E. Koditschek,et al.  Exact robot navigation using artificial potential functions , 1992, IEEE Trans. Robotics Autom..

[36]  Brian P. Gerkey.  Planning and Control in Unstructured Terrain , 2008 .

[37]  Antonio Sala,et al.  Reactive Sliding-Mode Algorithm for Collision Avoidance in Robotic Systems , 2013, IEEE Transactions on Control Systems Technology.

[38]  Oliver Brock,et al.  High-speed navigation using the global dynamic window approach , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[39]  R. Fierro,et al.  First-state contractive model predictive control of nonholonomic mobile robots , 2008, 2008 American Control Conference.

[40]  Thor I. Fossen,et al.  Integral LOS Path Following for Curved Paths Based on a Monotone Cubic Hermite Spline Parametrization , 2014, IEEE Transactions on Control Systems Technology.