Receding horizon estimation and control with structured noise blocking for mobile robot slip compensation

The control of field robots in varying and uncertain terrain conditions presents a challenge for autonomous navigation. Online estimation of the wheel-terrain slip characteristics is essential for generating the accurate control predictions necessary for tracking trajectories in off-road environments. Receding horizon estimation (RHE) provides a powerful framework for constrained estimation, and when combined with receding horizon control (RHC), yields an adaptive optimisation-based control method. Presently, such methods assume slip to be constant over the estimation horizon, while our proposed structured blocking approach relaxes this assumption, resulting in improved state and parameter estimation. We demonstrate and compare the performance of this method in simulation, and propose an overlapping-block strategy to ameliorate some of the limitations encountered in applying noise-blocking in a receding horizon estimation and control (RHEC) context.

[1]  Graham C. Goodwin,et al.  Robust model predictive control: reflections and opportunities , 2014 .

[2]  Arto Visala,et al.  Navigation system for agricultural machines: Nonlinear Model Predictive path tracking , 2012 .

[3]  Dezhen Song,et al.  Kinematic Modeling and Analysis of Skid-Steered Mobile Robots With Applications to Low-Cost Inertial-Measurement-Unit-Based Motion Estimation , 2009, IEEE Transactions on Robotics.

[4]  Girish Chowdhary,et al.  Embedded High Precision Control and Corn Stand Counting Algorithms for an Ultra-Compact 3D Printed Field Robot , 2018, Robotics: Science and Systems.

[5]  Liuping Wang.  Continuous time model predictive control design using orthonormal functions , 2001 .

[6]  Francisco Rodríguez,et al.  Robust tube-based predictive control for mobile robots in off-road conditions , 2011, Robotics Auton. Syst..

[7]  M. Diehl,et al.  Real-time optimization and nonlinear model predictive control of processes governed by differential-algebraic equations , 2000 .

[8]  Warren E. Dixon,et al.  Tracking and Regulation Control of a Mobile Robot System With Kinematic Disturbances: A Variable Structure-Like Approach , 2000 .

[9]  Angela P. Schoellig,et al.  Learning-based nonlinear model predictive control to improve vision-based mobile robot path-tracking in challenging outdoor environments , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Hugh F. Durrant-Whyte,et al.  The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications , 2001, IEEE Trans. Robotics Autom..

[11]  Pietro Perona,et al.  Learning and prediction of slip from visual information , 2007, J. Field Robotics.

[12]  Maria Letizia Corradini,et al.  Experimental testing of a discrete-time sliding mode controller for trajectory tracking of a wheeled mobile robot in the presence of skidding effects , 2002, J. Field Robotics.

[13]  S. Shankar Sastry,et al.  Provably safe and robust learning-based model predictive control , 2011, Autom..

[14]  Andrey V. Savkin,et al.  Nonlinear sliding mode control of an unmanned agricultural tractor in the presence of sliding and control saturation , 2013, Robotics Auton. Syst..

[15]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[16]  Philippe Martinet,et al.  Mixed kinematic and dynamic sideslip angle observer for accurate control of fast off‐road mobile robots , 2010, J. Field Robotics.

[17]  Erdal Kayacan,et al.  Distributed nonlinear model predictive control of an autonomous tractor-trailer system , 2014, ArXiv.

[18]  Moritz Diehl,et al.  Moving horizon estimation and nonlinear model predictive control for autonomous agricultural vehicles , 2013 .

[19]  Angela P. Schoellig,et al.  Robust Constrained Learning-based NMPC enabling reliable mobile robot path tracking , 2016, Int. J. Robotics Res..

[20]  Chris Manzie,et al.  Optimal move blocking strategies for model predictive control , 2015, Autom..

[21]  Calin Belta,et al.  Experimental Validation of Linear and Nonlinear MPC on an Articulated Unmanned Ground Vehicle , 2018, IEEE/ASME Transactions on Mechatronics.

[22]  Christian Kirches,et al.  qpOASES: a parametric active-set algorithm for quadratic programming , 2014, Mathematical Programming Computation.

[23]  Salah Sukkarieh,et al.  Suboptimal receding horizon estimation via noise blocking , 2018, Autom..

[24]  Danwei Wang,et al.  Maneuverability and path following control of wheeled mobile robot in the presence of wheel skidding and slipping , 2010, J. Field Robotics.

[25]  Francesco Borrelli,et al.  Kinematic and dynamic vehicle models for autonomous driving control design , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[26]  Zhong-Ping Jiang,et al.  Robust exponential regulation of nonholonomic systems with uncertainties , 2000, Autom..

[27]  Jarrod M. Snider.  Automatic Steering Methods for Autonomous Automobile Path Tracking , 2009 .

[28]  Danwei Wang,et al.  Modeling and Analysis of Skidding and Slipping in Wheeled Mobile Robots: Control Design Perspective , 2008, IEEE Transactions on Robotics.

[29]  Girish Chowdhary,et al.  High‐precision control of tracked field robots in the presence of unknown traction coefficients , 2018, J. Field Robotics.

[30]  Graham C. Goodwin,et al.  Predictive Metamorphic Control , 2011, 2011 8th Asian Control Conference (ASCC).

[31]  Efstratios N. Pistikopoulos,et al.  Moving horizon estimation: Error dynamics and bounding error sets for robust control , 2013, Autom..

[32]  Bor-Sen Chen,et al.  Adaptive tracking control for nonholonomic Caplygin systems , 2002, IEEE Trans. Control. Syst. Technol..

[33]  Moritz Diehl,et al.  High-speed moving horizon estimation based on automatic code generation , 2012, 2012 IEEE 51st IEEE Conference on Decision and Control (CDC).

[34]  Zongquan Deng,et al.  Wheel slip-sinkage and its prediction model of lunar rover , 2010 .

[35]  Moritz Diehl,et al.  ACADO toolkit—An open‐source framework for automatic control and dynamic optimization , 2011 .

[36]  Keiji Nagatani,et al.  Experimental study and analysis on driving wheels' performance for planetary exploration rovers moving in deformable soil , 2011 .

[37]  Angela P. Schoellig,et al.  Learning‐based Nonlinear Model Predictive Control to Improve Vision‐based Mobile Robot Path Tracking , 2016, J. Field Robotics.

[38]  Pieter Abbeel,et al.  Using inaccurate models in reinforcement learning , 2006, ICML.

[39]  Norihiko Adachi,et al.  Adaptive tracking control of a nonholonomic mobile robot , 2000, IEEE Trans. Robotics Autom..

[40]  Wouter Saeys,et al.  Robust Tube-Based Decentralized Nonlinear Model Predictive Control of an Autonomous Tractor-Trailer System , 2015, IEEE/ASME Transactions on Mechatronics.

[41]  Hong Jang,et al.  Move blocking strategy applied to re-entrant manufacturing line scheduling , 2015 .

[42]  Philippe Martinet,et al.  High accuracy path tracking for vehicles in presence of sliding: Application to farm vehicle automatic guidance for agricultural tasks , 2006, Auton. Robots.

[43]  Eric Bullinger,et al.  Simple and efficient moving horizon estimation based on the fast gradient method , 2015 .

[44]  Jay H. Lee,et al.  Constrained linear state estimation - a moving horizon approach , 2001, Autom..