A non linear model predictive tracking controller for agricultural vehicles

It is expected that precision farming operations will increasingly rely on more complex automatic steering and navigation capabilities of agricultural vehicles. In this paper, a nonlinear model predictive tracking (NMPT) controller is presented for precision guidance in agricultural applications. The basic idea is to use a motion model for the vehicle and compute in real-time an optimal M-step-ahead control sequence, which minimizes the total M+1 step tracking error of the projected motion. Numerous simulations were performed and the NMPT consistently converged to the desired trajectories and followed them accurately, despite large initial errors and discontinuities in the desired velocities and orientations. The controller's performance was superior to pure-pursuit control and depended strongly on parameters such as the optimization horizon M, and the cost-weights assigned to the various tracking errors. The optimization horizon regulates a trade-off between tracking quality (large M) vs. consistently fast convergence (small M). The cost-weights affect tracking quality and also the shape of the path, by regulating trade-offs among position, orientation, and velocity errors. Overall, NMPT seems to offer a promising approach for advanced precision guidance applications, and deserves further investigation.

[1]  David G. Armstrong,et al.  Autonomous ground vehicle path tracking , 2004 .

[2]  J. F. Reid,et al.  Model Recognition and Simulation of an E/H Steering Controller on Off-Road Equipment , 1998 .

[3]  Basil Kouvaritakis,et al.  Nonlinear predictive control : theory and practice , 2001 .

[4]  Jung-Min Yang,et al.  Sliding mode control of a nonholonomic wheeled mobile robot for trajectory tracking , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[5]  Harold J. Kushner,et al.  Stochastic Approximation Algorithms and Applications , 1997, Applications of Mathematics.

[6]  J.T. Wen,et al.  Nonlinear model predictive control based on predicted state error convergence , 2004, Proceedings of the 2004 American Control Conference.

[7]  Charles E. Thorpe,et al.  Integrated mobile robot control , 1991 .

[8]  Carl D. Crane,et al.  Autonomous ground vehicle path tracking , 2004, J. Field Robotics.

[9]  Antonio Bicchi,et al.  Path tracking control for Dubin's cars , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[10]  P. Strevens Iii , 1985 .

[11]  J. Betts Survey of Numerical Methods for Trajectory Optimization , 1998 .

[12]  Steven A. Velinsky,et al.  On the Tracking Control of Differentially Steered Wheeled Mobile Robots , 1997 .

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

[14]  J. F. Reid,et al.  Adaptive steering controller using a Kalman estimator for wheel-type agricultural tractors , 2001, Robotica.

[15]  Donald E. Kirk,et al.  Optimal control theory : an introduction , 1970 .

[16]  G. Siouris,et al.  Optimum systems control , 1979, Proceedings of the IEEE.

[17]  Hong Chen,et al.  Nonlinear Model Predictive Control Schemes with Guaranteed Stability , 1998 .

[18]  John T. Wen,et al.  Trajectory tracking control of a car-trailer system , 1997, IEEE Trans. Control. Syst. Technol..