Systematic convergence of nonlinear stochastic estimators on the Special Orthogonal Group SO(3)

This paper introduces two novel nonlinear stochastic attitude estimators developed on the Special Orthogonal Group \mathbb{SO}\left(3\right) with the tracking error of the normalized Euclidean distance meeting predefined transient and steady-state characteristics. The tracking error is confined to initially start within a predetermined large set such that the transient performance is guaranteed to obey dynamically reducing boundaries and decrease smoothly and asymptotically to the origin in probability from almost any initial condition. The proposed estimators produce accurate attitude estimates with remarkable convergence properties using measurements obtained from low-cost inertial measurement units. Unit-quaternion representation of the proposed filters are presented. The estimators proposed in continuous form are complemented by their discrete versions for the implementation purposes. The simulation results illustrate the effectiveness and robustness of the proposed estimators against uncertain measurements and large initialization error, whether in continuous or discrete form. Keywods: Attitude estimates, transient, steady-state error, nonlinear filter, special orthogonal group, SO(3), stochastic system, stochastic differential equations, Ito, Stratonovich, asymptotic stability, Wong-Zakai, inertial measurment unit, IMU, prescribed performance function, Euler Angles, roll, bitch, yaw, color noise, white noise, Nonlinear attitude filter, Nonlinear attitude observer, Orientation, nonlinear stochastic attitude filter on SO(3), unit-quaternion based nonlinear stochastic attitude filter, discrete stochastic attitude filter.

[1]  Frank L. Lewis,et al.  Neuro-adaptive cooperative tracking control with prescribed performance of unknown higher-order nonlinear multi-agent systems , 2018, Int. J. Control.

[2]  F. Markley Attitude Error Representations for Kalman Filtering , 2003 .

[3]  Charalampos P. Bechlioulis,et al.  Robust Adaptive Control of Feedback Linearizable MIMO Nonlinear Systems With Prescribed Performance , 2008, IEEE Transactions on Automatic Control.

[4]  Hashim A. Hashim Special Orthogonal Group SO(3), Euler Angles, Angle-axis, Rodriguez Vector and Unit-Quaternion: Overview, Mapping and Challenges , 2019, ArXiv.

[5]  Miroslav Krstic,et al.  Stabilization of stochastic nonlinear systems driven by noise of unknown covariance , 2001, IEEE Trans. Autom. Control..

[6]  Hashim A. Hashim,et al.  Nonlinear Stochastic Attitude Filters on the Special Orthogonal Group 3: Ito and Stratonovich , 2018, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

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

[8]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[9]  R. G. Medhurst,et al.  Topics in the Theory of Random Noise , 1969 .

[10]  William G. Faris Lectures on Stochastic Processes , 2004 .

[11]  Hashim A. Hashim,et al.  Nonlinear Explicit Stochastic Attitude Filter on SO(3) , 2018, 2018 IEEE Conference on Decision and Control (CDC).

[12]  H. Mohamed Nonlinear Attitude and Pose Filters with Superior Convergence Properties , 2019 .

[13]  John L. Crassidis,et al.  Survey of nonlinear attitude estimation methods , 2007 .

[14]  Yuezu Lv,et al.  Distributed attitude synchronization control for multiple flexible spacecraft without modal variable measurement , 2018 .

[15]  Hashim A. Hashim,et al.  Attitude Determination and Estimation using Vector Observations: Review, Challenges and Comparative Results , 2020, ArXiv.

[16]  R. Khasminskii Stochastic Stability of Differential Equations , 1980 .

[17]  James Richard Forbes,et al.  Nonlinear Estimator Design on the Special Orthogonal Group Using Vector Measurements Directly , 2017, IEEE Transactions on Automatic Control.

[18]  F. Markley Attitude determination using vector observations and the singular value decomposition , 1988 .

[19]  Zhiyong Geng,et al.  Distributed observer‐based leader‐follower attitude consensus control for multiple rigid bodies using rotation matrices , 2019, International Journal of Robust and Nonlinear Control.

[20]  Lihua Xie,et al.  Event‐triggered control for a saturated nonlinear system with prescribed performance and finite‐time convergence , 2018, International Journal of Robust and Nonlinear Control.

[21]  M. Shuster,et al.  Three-axis attitude determination from vector observations , 1981 .

[22]  E. M. Jafarov,et al.  Robust stabilization of spacecraft attitude motion under magnetic control through time‐varying integral sliding mode , 2019, International Journal of Robust and Nonlinear Control.

[23]  T. Hamel,et al.  Complementary filter design on the special orthogonal group SO(3) , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[24]  R. L. Stratonovich,et al.  Topics in the theory of random noise , 1967 .

[25]  M. Shuster A survey of attitude representation , 1993 .

[26]  Florian Nadel,et al.  Stochastic Processes And Filtering Theory , 2016 .

[27]  Malcolm D. Shuster Survey of attitude representations , 1993 .

[28]  Hashim A. Hashim,et al.  Guaranteed Performance of Nonlinear Attitude Filters on the Special Orthogonal Group SO(3) , 2018, IEEE Access.

[29]  Miroslav Krstic,et al.  Stabilization of Nonlinear Uncertain Systems , 1998 .

[30]  Taeyoung Lee,et al.  Exponential stability of an attitude tracking control system on SO(3) for large-angle rotational maneuvers , 2012, Syst. Control. Lett..

[31]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[32]  M. Krstić,et al.  Stochastic nonlinear stabilization—I: a backstepping design , 1997 .

[33]  A. D. Lewis,et al.  Geometric control of mechanical systems : modeling, analysis, and design for simple mechanical control systems , 2005 .

[34]  Robert E. Mahony,et al.  Nonlinear Complementary Filters on the Special Orthogonal Group , 2008, IEEE Transactions on Automatic Control.

[35]  Robert E. Mahony,et al.  Attitude estimation on SO[3] based on direct inertial measurements , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[36]  Tor Arne Johansen,et al.  Attitude Estimation Using Biased Gyro and Vector Measurements With Time-Varying Reference Vectors , 2012, IEEE Transactions on Automatic Control.