Pure Perception Motion Control based on Stochastic Nonlinear Model Predictive Control

Noise coming from sensors or caused by external world phenomena results in measurement errors that cause uncertainties in some robotic tasks, e.g. tracking a robot displacement and tracking an observed target. Control approaches such as model predictive control (MPC) usually guarantee constraints satisfaction by way of using detailed models of prediction. Although the deterministic MPC allows certain robustness to be controlled in the system, it usually does not adequately deal with uncertainties. Therefore, we introduce in this manuscript a pure perception motion control, which consists of an approach that deals with the uncertainty problem through a stochastic nonlinear model predictive control (SNMPC) by minimizing only the covariances matrices of target observation and robot state estimation. As introduced previously, it can be used to track targets that are observed during some tasks. The SNMPC penalizes the undesired behavior, allowing the robot to converge to the optimal pose to observe the target optimally. A modification provided both in the prediction model and the cost function allows this minimization to be achieved. The proposed stochastic nonlinear controller is validated, providing a satisfactory control of the target tracking, by way of results obtained from simulation, which are presented and discussed in the paper to verify our proposal.

[1]  Francesco Borrelli,et al.  Stochastic predictive control for semi-autonomous vehicles with an uncertain driver model , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[2]  Fabio Morbidi,et al.  Active Target Tracking and Cooperative Localization for Teams of Aerial Vehicles , 2013, IEEE Transactions on Control Systems Technology.

[3]  Andrea Bonarini,et al.  Intelligent state changing applied to multi-robot systems , 2013, Robotics Auton. Syst..

[4]  Joel A. Paulson,et al.  Lyapunov-based stochastic nonlinear model predictive control: Shaping the state probability distribution functions , 2015, 2016 American Control Conference (ACC).

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

[6]  Christian Jutten,et al.  A Fast Approach for Overcomplete Sparse Decomposition Based on Smoothed $\ell ^{0}$ Norm , 2008, IEEE Transactions on Signal Processing.

[7]  André Dias,et al.  Formation control driven by cooperative object tracking , 2015, Robotics Auton. Syst..

[8]  Masahiro Ono,et al.  Chance-Constrained Optimal Path Planning With Obstacles , 2011, IEEE Transactions on Robotics.

[9]  A. Mesbah,et al.  Stochastic Model Predictive Control: An Overview and Perspectives for Future Research , 2016, IEEE Control Systems.

[10]  António Paulo Moreira,et al.  Multi-robot nonlinear model predictive formation control: Moving target and target absence , 2013, Robotics Auton. Syst..

[11]  Masahiro Ono,et al.  A Probabilistic Particle-Control Approximation of Chance-Constrained Stochastic Predictive Control , 2010, IEEE Transactions on Robotics.

[12]  Carlos E. T. Dorea,et al.  Design and Implementation of Model-Predictive Control With Friction Compensation on an Omnidirectional Mobile Robot , 2014, IEEE/ASME Transactions on Mechatronics.

[13]  Shahram Yousefi,et al.  Multiple cooperative UAVs target tracking using Learning Based Model Predictive Control , 2015, 2015 International Conference on Unmanned Aircraft Systems (ICUAS).

[14]  Alisson V. Brito,et al.  Kalman Filter With Dynamical Setting of Optimal Process Noise Covariance , 2017, IEEE Access.

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

[16]  Luiz Marcos Garcia Gonçalves,et al.  Stochastic Nonlinear Model Predictive Mobile Robot Motion Control , 2018, 2018 Latin American Robotic Symposium, 2018 Brazilian Symposium on Robotics (SBR) and 2018 Workshop on Robotics in Education (WRE).

[17]  António Paulo Moreira,et al.  Multi-Robot nonlinear model predictive formation control: the obstacle avoidance problem , 2014, Robotica.

[18]  Marcello R. Napolitano,et al.  Design and Flight Testing Evaluation of Formation Control Laws , 2006, IEEE Transactions on Control Systems Technology.

[19]  Hongxia Ji,et al.  Multi-UAVs tracking target in urban environment by model predictive control and Improved Grey Wolf Optimizer , 2016 .

[20]  Richard D. Braatz,et al.  Stochastic nonlinear model predictive control with probabilistic constraints , 2014, 2014 American Control Conference.

[21]  Pedro U. Lima,et al.  Multi-robot cooperative spherical-object tracking in 3D space based on particle filters , 2013, Robotics Auton. Syst..

[22]  André Scolari Conceição,et al.  A nonlinear model predictive control strategy for trajectory tracking of a four‐wheeled omnidirectional mobile robot , 2008 .

[23]  Peyman Mohajerin Esfahani,et al.  Stochastic Nonlinear Model Predictive Control of an Uncertain Batch Polymerization Reactor , 2015 .

[24]  Marco F. Huber,et al.  Stochastic Nonlinear Model Predictive Control based on Gaussian Mixture Approximations , 2009 .

[25]  Randy A. Freeman,et al.  Distributed Cooperative Active Sensing Using Consensus Filters , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[26]  João Pedro Hespanha,et al.  Robust UAV coordination for target tracking using output-feedback model predictive control with moving horizon estimation , 2015, 2015 American Control Conference (ACC).

[27]  Changchun Liu,et al.  Nonlinear stochastic predictive control with unscented transformation for semi-autonomous vehicles , 2014, 2014 American Control Conference.

[28]  Basil Kouvaritakis,et al.  Probabilistic tubes in linear stochastic model predictive control , 2009, Syst. Control. Lett..

[29]  Tucker R. Balch,et al.  Value-based action selection for observation with robot teams using probabilistic techniques , 2005, Robotics Auton. Syst..

[30]  Uwe D. Hanebeck,et al.  Stochastic model predictive control of time-variant nonlinear systems with imperfect state information , 2008, 2008 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems.

[31]  Stergios I. Roumeliotis,et al.  Multirobot Active Target Tracking With Combinations of Relative Observations , 2011, IEEE Transactions on Robotics.

[32]  Gianni Ferretti,et al.  LFT-based MPC Control of an Autonomous Vehicle , 2016 .

[33]  Martin A. Riedmiller,et al.  A direct adaptive method for faster backpropagation learning: the RPROP algorithm , 1993, IEEE International Conference on Neural Networks.

[34]  Robin J. Evans,et al.  Hierarchical model predictive control of UAVs performing multitarget-multisensor tracking , 2014, IEEE Transactions on Aerospace and Electronic Systems.