Nonlinear fisher particle output feedback control and its application to terrain aided navigation

This paper presents state estimation and stochastic optimal control gathered in one global optimization problem generating dual effect i.e. the control can improve the future estimation. As the optimal policy is impossible to compute, a sub-optimal policy that preserves this coupling is constructed thanks to the Fisher Information Matrix (FIM) and a Particle Filter. This method has been applied to the localization and guidance of a drone over a known terrain with height measurements only. The results show that the new method improves the estimation accuracy compared to nominal trajectories.

[1]  Sebastian Engell,et al.  Economic Multi-stage Output Feedback NMPC using the Unscented Kalman Filter , 2015 .

[2]  Petros G. Voulgaris,et al.  On optimal ℓ∞ to ℓ∞ filtering , 1995, Autom..

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

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

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

[6]  Timothy J. Robinson,et al.  Sequential Monte Carlo Methods in Practice , 2003 .

[7]  Robert R. Bitmead,et al.  Particle Model Predictive Control: Tractable Stochastic Nonlinear Output-Feedback MPC , 2016, 1612.00505.

[8]  Jan Hauth,et al.  PF-MPC: Particle filter-model predictive control , 2011, Syst. Control. Lett..

[9]  Dimitri P. Bertsekas,et al.  Dynamic Programming and Optimal Control, Two Volume Set , 1995 .

[10]  Alan Schumitzky,et al.  Implicit dual control based on particle filtering and forward dynamic programming , 2008, International journal of adaptive control and signal processing.

[11]  João Pedro Hespanha,et al.  Nonlinear output-feedback model predictive control with moving horizon estimation , 2014, 53rd IEEE Conference on Decision and Control.

[12]  Y. Bar-Shalom,et al.  Dual effect, certainty equivalence, and separation in stochastic control , 1974 .

[13]  Carlos H. Muravchik,et al.  Posterior Cramer-Rao bounds for discrete-time nonlinear filtering , 1998, IEEE Trans. Signal Process..

[14]  Bjarne A. Foss,et al.  Scenario Based Implicit Dual Model Predictive Control , 2015 .