Path Following with an Optimal Forward Velocity for a Mobile Robot

Abstract In this paper, we present a novel solution for a path following problem in partially-known static environments. Given linearized error dynamic equations, model predictive control (MPC) is employed to produce a sequence of angular velocities. Since the forward velocity of the robot has to be adapted to environmental constraints and robot dynamics while the robot is following a path, we propose an optimal solution to generate the velocity profile. Furthermore, we integrate an obstacle-avoidance behavior using local sensor information with a path-following behavior based on global knowledge. To achieve this, we introduce new waypoints in order to move the robot away from obstacles while the robot still keeps following the desired path. Extensive simulations and experiments with a physical unicycle mobile robot have been conducted to illustrate the effectiveness of our path following control framework.

[1]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[2]  Peter Spellucci,et al.  An SQP method for general nonlinear programs using only equality constrained subproblems , 1998, Math. Program..

[3]  C. Samson,et al.  Trajectory tracking for unicycle-type and two-steering-wheels mobile robots , 1993 .

[4]  P. Encarnacao,et al.  3D path following for autonomous underwater vehicle , 2000, Proceedings of the 39th IEEE Conference on Decision and Control (Cat. No.00CH37187).

[5]  C. Samson Control of chained systems application to path following and time-varying point-stabilization of mobile robots , 1995, IEEE Trans. Autom. Control..

[6]  G. Niemeyer,et al.  Springer Handbook of Robotics: Chapter 31 , 2008 .

[7]  Gregor Klan Tracking-error model-based predictive control for mobile robots in real time , 2007 .

[8]  Ole Ravn,et al.  Receding horizon approach to path following mobile robot in the presence of velocity constraints , 2001, 2001 European Control Conference (ECC).

[9]  Walter Fetter Lages,et al.  REAL-TIME CONTROL OF A MOBILE ROBOT USING LINEARIZED MODEL PREDICTIVE CONTROL , 2006 .

[10]  A. Ollero,et al.  Predictive path tracking of mobile robots. Application to the CMU NavLab , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[11]  Claudio Altani Following a path of varying curvature as an output regulation problem , 1999 .

[12]  N. Harris McClamroch,et al.  Tracking and maneuver regulation control for nonlinear nonminimum phase systems: application to flight control , 2002, IEEE Trans. Control. Syst. Technol..

[13]  Roland Siegwart,et al.  Path Following for Autonomous Vehicle Navigation Based on Kinodynamic Control , 2009, J. Comput. Inf. Technol..

[14]  Dongbing Gu,et al.  Receding horizon tracking control of wheeled mobile robots , 2006, IEEE Transactions on Control Systems Technology.

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

[16]  Lionel Lapierre,et al.  Combined Path-following and Obstacle Avoidance Control of a Wheeled Robot , 2007, Int. J. Robotics Res..

[17]  Andreas Nüchter,et al.  High Speed Differential Drive Mobile Robot Path Following Control With Bounded Wheel Speed Commands , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[18]  W. Kwon,et al.  Receding Horizon Control: Model Predictive Control for State Models , 2005 .