A Receding Horizon Framework for Autonomy in Unmanned Vehicles

In this article we present a unified framework based on receding horizon techniques that can be used to design the three tasks (guidance, navigation and path-planning) which are involved in the autonomy of unmanned vehicles. This tasks are solved using model predictive control and moving horizon estimation techniques, which allows us to include physical and dynamical constraints at the design stage, thus leading to optimal and feasible results. In order to demonstrate the capabilities of the proposed framework, we have used Gazebo simulator in order to drive a Jackal unmanned ground vehicle (UGV) along a desired path computed by the path-planning task. The results we have obtained are successful as the estimation and guidance errors are small and the Jackal UGV is able to follow the desired path satisfactorily and it is also capable to avoid the obstacles which are in its way.

[1]  Pascual Campoy Cervera,et al.  A Review of Deep Learning Methods and Applications for Unmanned Aerial Vehicles , 2017, J. Sensors.

[2]  Xianku Zhang,et al.  A novel DVS guidance principle and robust adaptive path-following control for underactuated ships using low frequency gain-learning. , 2015, ISA transactions.

[3]  U. S. Military.  Unmanned Aircraft Systems , 2011 .

[4]  Tor Arne Johansen,et al.  A nonlinear observer for integration of GNSS and IMU measurements with gyro bias estimation , 2012, 2012 American Control Conference (ACC).

[5]  Marcello R. Napolitano,et al.  Sensitivity Analysis of Extended and Unscented Kalman Filters for Attitude Estimation , 2013, J. Aerosp. Inf. Syst..

[6]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[7]  Jianda Han,et al.  Survey of Robot 3D Path Planning Algorithms , 2016 .

[8]  J. Crassidis,et al.  Particle Filtering for Sequential Spacecraft Attitude Estimation , 2004 .

[9]  Jun Li,et al.  Dynamic analysis and PID control for a quadrotor , 2011, 2011 IEEE International Conference on Mechatronics and Automation.

[10]  D. Simon.  Kalman filtering with state constraints: a survey of linear and nonlinear algorithms , 2010 .

[11]  Tao Mei,et al.  Design of a Control System for an Autonomous Vehicle Based on Adaptive-PID , 2012 .

[12]  Vu Trieu Minh,et al.  Feasible Path Planning for Autonomous Vehicles , 2014 .

[13]  Esmat Bekir.  Introduction to Modern Navigation Systems , 2007 .

[14]  Yaakov Oshman,et al.  Adaptive Particle Filtering for Spacecraft Attitude Estimation from Vector Observations , 2009 .

[15]  Stergios I. Roumeliotis,et al.  3-D Localization for a Mars Rover Prototype , 1999 .

[16]  Leonardo Giovanini,et al.  MPC for nonlinear systems: A comparative review of discretization methods , 2017, 2017 XVII Workshop on Information Processing and Control (RPIC).

[17]  M. Murillo,et al.  Iterated non-linear model predictive control based on tubes and contractive constraints. , 2016, ISA transactions.

[18]  Nong Cheng,et al.  Offline path planning and online replanning of UAVs in complex terrain , 2014, Proceedings of 2014 IEEE Chinese Guidance, Navigation and Control Conference.

[19]  Farrokh Janabi-Sharifi,et al.  UKF-Based LQR Control of a Manipulating Unmanned Aerial Vehicle , 2017, Unmanned Syst..

[20]  L Giovanini,et al.  Adaptive arrival cost update for improving Moving Horizon Estimation performance. , 2017, ISA transactions.

[21]  E. J. Lefferts,et al.  Kalman Filtering for Spacecraft Attitude Estimation , 1982 .

[22]  Marina H. Murillo,et al.  A Real-Time Path-Planning Algorithm based on Receding Horizon Techniques , 2018, J. Intell. Robotic Syst..

[23]  Robert R. Bitmead,et al.  State estimation for linear systems with state equality constraints , 2007, Autom..

[24]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[25]  Dan Simon,et al.  Constrained Kalman filtering via density function truncation for turbofan engine health estimation , 2010, Int. J. Syst. Sci..

[26]  D. L. Hall,et al.  Mathematical Techniques in Multisensor Data Fusion , 1992 .

[27]  Dennis S. Bernstein,et al.  Gain-Constrained Kalman Filtering for Linear and Nonlinear Systems , 2008, IEEE Transactions on Signal Processing.

[28]  James B. Rawlings,et al.  Critical Evaluation of Extended Kalman Filtering and Moving-Horizon Estimation , 2005 .

[29]  Siyuan Liu,et al.  Fully-tuned fuzzy neural network based robust adaptive tracking control of unmanned underwater vehicle with thruster dynamics , 2016, Neurocomputing.

[30]  D. Simon,et al.  Kalman filtering with state equality constraints , 2002 .

[31]  Peng Hang,et al.  Path tracking control of a four-wheel-independent-steering electric vehicle based on model predictive control , 2017, 2017 36th Chinese Control Conference (CCC).

[32]  A. Tonello,et al.  Altitude and attitude tracking of a quadrotor helicopter UAV using a novel evolutionary feedback controller , 2017, 2017 International Conference on Smart Systems and Technologies (SST).

[33]  Martin Saska,et al.  Predictive control and stabilization of nonholonomic formations with integrated spline-path planning , 2016, Robotics Auton. Syst..

[34]  Markus Hehn,et al.  Real-Time Trajectory Generation for Quadrocopters , 2015, IEEE Transactions on Robotics.

[35]  F. Landis Markley,et al.  Kalman Filter for Spinning Spacecraft Attitude Estimation , 2007 .

[36]  F. Markley,et al.  Unscented Filtering for Spacecraft Attitude Estimation , 2003 .

[37]  Jan Swevers,et al.  Spacecraft Attitude Estimation and Sensor Calibration Using Moving Horizon Estimation , 2013 .