An EKF-Based Fast Tube MPC Scheme for Moving Target Tracking of a Redundant Underwater Vehicle-Manipulator System

This paper presents a control scheme for addressing the moving target grabbing problem by a kinematically constrained redundant underwater vehicle-manipulator system (UVMS) in the presence of unmodeled uncertainties, sensory detecting noises, and time-varying external disturbances. Our proposed control scheme is designed by a robust fast tube model predictive controller (FTMPC) with an extended Kalman filter (EKF) target observer. The proposed robust FTMPC consists of an online fast nominal MPC and an online ancillary nonlinear controller to overcome the uncertainties and disturbances of the UVMS. The problem of the UVMS kinematic redundancy and mechanical/physical constraints is translated into a part of online optimization of FTMPC. The feasibility and stability of the FTMPC are proved. The proposed EKF observer is used to estimate the moving target trajectory and overcome the sensory measurement (system) noises, which can eliminate the assumption that most prior existing research works need to know the tracking reference trajectory precisely. Finally, the effectiveness of the proposed control scheme is verified through a series of UWSim simulations by the 6-degree-of-freedom (DoF) vehicle and 5-DoF manipulator GIRONA500 UVMS.

[1]  Manfred Morari,et al.  A Multiresolution Approximation Method for Fast Explicit Model Predictive Control , 2011, IEEE Transactions on Automatic Control.

[2]  Manfred Morari,et al.  On real-time robust model predictive control , 2014, Autom..

[3]  Chenguang Yang,et al.  Corrections to "Extended State Observer-Based Integral Sliding Mode Control for an Underwater Robot With Unknown Disturbances and Uncertain Nonlinearities" , 2019, IEEE Trans. Ind. Electron..

[4]  Huiping Li,et al.  Model Predictive Stabilization of Constrained Underactuated Autonomous Underwater Vehicles With Guaranteed Feasibility and Stability , 2017, IEEE/ASME Transactions on Mechatronics.

[5]  Yan Yan,et al.  Formation control of multiple underwater vehicles subject to communication faults and uncertainties , 2019, Applied Ocean Research.

[6]  David Q. Mayne,et al.  Model predictive control: Recent developments and future promise , 2014, Autom..

[7]  Huazhen Fang,et al.  Advanced Control in Marine Mechatronic Systems: A Survey , 2017, IEEE/ASME Transactions on Mechatronics.

[8]  Yan Yan,et al.  An Adaptive EKF-FMPC for the Trajectory Tracking of UVMS , 2020, IEEE Journal of Oceanic Engineering.

[9]  Ming Yue,et al.  Robust Tube-Based Model Predictive Control for Lane Change Maneuver of Tractor-Trailer Vehicles Based on a Polynomial Trajectory , 2020, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[10]  Laxman M. Waghmare,et al.  Disturbance estimator based non-singular fast fuzzy terminal sliding mode control of an autonomous underwater vehicle , 2018, Ocean Engineering.

[11]  Dimos V. Dimarogonas,et al.  A Tube-based MPC Scheme for Interaction Control of Underwater Vehicle Manipulator Systems , 2018, 2018 IEEE/OES Autonomous Underwater Vehicle Workshop (AUV).

[12]  Min Tan,et al.  Floating Autonomous Manipulation of the Underwater Biomimetic Vehicle-Manipulator System: Methodology and Verification , 2018, IEEE Transactions on Industrial Electronics.

[13]  Kamran Mohseni,et al.  Bioinspired Hydrodynamic Force Feedforward for Autonomous Underwater Vehicle Control , 2014, IEEE/ASME Transactions on Mechatronics.

[14]  Leigh McCue,et al.  Handbook of Marine Craft Hydrodynamics and Motion Control [Bookshelf] , 2016, IEEE Control Systems.

[15]  Xuhui Feng,et al.  Min-max Differential Inequalities for Polytopic Tube MPC , 2019, 2019 American Control Conference (ACC).

[16]  Pedro J. Sanz,et al.  An open source tool for simulation and supervision of underwater intervention missions , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Cheng Siong Chin,et al.  Robust Genetic Algorithm and Fuzzy Inference Mechanism Embedded in a Sliding-Mode Controller for an Uncertain Underwater Robot , 2018, IEEE/ASME Transactions on Mechatronics.

[18]  Hong Chen,et al.  Simultaneous Trajectory Planning and Tracking Using an MPC Method for Cyber-Physical Systems: A Case Study of Obstacle Avoidance for an Intelligent Vehicle , 2018, IEEE Transactions on Industrial Informatics.

[19]  Antonella Ferrara,et al.  MPC for Robot Manipulators With Integral Sliding Modes Generation , 2017, IEEE/ASME Transactions on Mechatronics.

[20]  Chao Shen,et al.  Integrated Path Planning and Tracking Control of an AUV: A Unified Receding Horizon Optimization Approach , 2017, IEEE/ASME Transactions on Mechatronics.

[21]  Donghee Kim,et al.  Trajectory generation and sliding-mode controller design of an underwater vehicle-manipulator system with redundancy , 2015 .

[22]  Caoyang Yu,et al.  Guidance-Error-Based Robust Fuzzy Adaptive Control for Bottom Following of a Flight-Style AUV With Saturated Actuator Dynamics , 2020, IEEE Transactions on Cybernetics.

[23]  Shuanghe Yu,et al.  Design of an indirect adaptive controller for the trajectory tracking of UVMS , 2018 .

[24]  Michael Nikolaou,et al.  MPC: Current practice and challenges , 2012 .

[25]  Ron P. Podhorodeski,et al.  Redundancy resolution for underwater mobile manipulators , 2010 .

[26]  Andreas Müller,et al.  On Higher Order Inverse Kinematics Methods in Time-Optimal Trajectory Planning for Kinematically Redundant Manipulators , 2018, IEEE Transactions on Industrial Informatics.

[27]  Dewei Li,et al.  An Improved Predictive Controller on the FPGA by Hardware Matrix Inversion , 2018, IEEE Transactions on Industrial Electronics.

[28]  Chenguang Yang,et al.  Extended State Observer-Based Integral Sliding Mode Control for an Underwater Robot With Unknown Disturbances and Uncertain Nonlinearities , 2017, IEEE Transactions on Industrial Electronics.

[29]  Giuseppe Casalino,et al.  Manipulation and Transportation With Cooperative Underwater Vehicle Manipulator Systems , 2017, IEEE Journal of Oceanic Engineering.

[30]  Junbo Zhao,et al.  Dynamic State Estimation With Model Uncertainties Using $H_\infty$ Extended Kalman Filter , 2018, IEEE Transactions on Power Systems.

[31]  F. Allgöwer,et al.  A quasi-infinite horizon nonlinear model predictive control scheme with guaranteed stability , 1997 .

[32]  Fang Xu,et al.  Stability of finite horizon model predictive control with incremental input constraints , 2017, Autom..

[33]  S. Koteswara Rao,et al.  Data fusion for underwater target tracking , 2010 .

[34]  F. Allgöwer,et al.  Tube MPC scheme based on robust control invariant set with application to Lipschitz nonlinear systems , 2011, IEEE Conference on Decision and Control and European Control Conference.

[35]  Jihoon Kim,et al.  Six-Degree-of-Freedom Hovering Control of an Underwater Robotic Platform With Four Tilting Thrusters via Selective Switching Control , 2015, IEEE/ASME Transactions on Mechatronics.

[36]  Chao Shen,et al.  Trajectory Tracking Control of an Autonomous Underwater Vehicle Using Lyapunov-Based Model Predictive Control , 2018, IEEE Transactions on Industrial Electronics.

[37]  Qing-Long Han,et al.  Network-Based T–S Fuzzy Dynamic Positioning Controller Design for Unmanned Marine Vehicles , 2018, IEEE Transactions on Cybernetics.

[38]  Qing-Long Han,et al.  Network-based modelling and dynamic output feedback control for unmanned marine vehicles in network environments , 2018, Autom..

[39]  Junzhi Yu,et al.  Motion Control Strategies for a Repetitive Leaping Robotic Dolphin , 2019, IEEE/ASME Transactions on Mechatronics.

[40]  Moritz Diehl,et al.  Robust MPC via min-max differential inequalities , 2016, Autom..