A Trident Quaternion Framework for Inertial-Based Navigation Part I: Rigid Motion Representation and Computation

Strapdown inertial navigation research involves the parameterization and computation of the attitude, velocity, and position of a rigid body in a chosen reference frame. The community has long devoted to finding the most concise and efficient representation for the strapdown inertial navigation system (INS). The current work is motivated by simplifying the existing dual quaternion representation of the kinematic model. This article proposes a compact and elegant representation of the body's attitude/velocity/position, with the aid of a devised trident quaternion tool, which is an extension of dual quaternions. And the position is accounted for by adding a second dual part to the dual quaternion. Eventually, the kinematics of the strapdown INS are cohesively unified in one concise differential equation, which bears the same form as the classical attitude quaternion differential equation. In addition, the numerical solution to this trident quaternion-based kinematic equation is dealt with the recently proposed functional iterative integration approach. Numerical results are provided to verify the analysis. The new representation not only provides an elegant kinematic form of inertial navigation, but gives birth to precision inertial navigation algorithm.

[1]  Mario Ignagni Accuracy Limits on Strapdown Velocity and Position Computations , 2020 .

[2]  Moshe Shoham,et al.  Application of hyper-dual numbers to rigid bodies equations of motion , 2017 .

[3]  Yuanxin Wu iNavFIter: Next-Generation Inertial Navigation Computation Based on Functional Iteration , 2019, IEEE Transactions on Aerospace and Electronic Systems.

[4]  Qing Wei,et al.  Control of Oriented Mechanical systems: A Method Based on Dual Quaternion , 2008 .

[5]  J. E. Glynn,et al.  Numerical Recipes: The Art of Scientific Computing , 1989 .

[6]  Nikos A. Aspragathos,et al.  A comparative study of three methods for robot kinematics , 1998, IEEE Trans. Syst. Man Cybern. Part B.

[7]  P. Savage Strapdown Inertial Navigation Integration Algorithm Design Part 1: Attitude Algorithms , 1998 .

[8]  Olav Egeland,et al.  Dual Quaternion Particle Filtering for Pose Estimation , 2020, IEEE Transactions on Control Systems Technology.

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

[10]  Roland Siegwart,et al.  Iterated extended Kalman filter based visual-inertial odometry using direct photometric feedback , 2017, Int. J. Robotics Res..

[11]  Howie Choset,et al.  Estimating SE(3) elements using a dual quaternion based linear Kalman filter , 2016, Robotics: Science and Systems.

[12]  H. L. Hime “The Elements of Quaternions” , 1894, Nature.

[13]  Yuanxin Wu,et al.  Next-Generation Inertial Navigation Computation Based on Functional Iteration , 2019, 2019 26th Saint Petersburg International Conference on Integrated Navigation Systems (ICINS).

[14]  Uwe D. Hanebeck,et al.  Stereo Visual SLAM Based on Unscented Dual Quaternion Filtering , 2019, 2019 22th International Conference on Information Fusion (FUSION).

[15]  Uwe D. Hanebeck,et al.  Unscented Dual Quaternion Particle Filter for SE(3) Estimation , 2021, IEEE Control Systems Letters.

[16]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[17]  Panagiotis Tsiotras,et al.  Extended Kalman Filter for spacecraft pose estimation using dual quaternions , 2015, 2015 American Control Conference (ACC).

[18]  Yuanxin Wu,et al.  Fast RodFIter for Attitude Reconstruction From Inertial Measurements , 2018, IEEE Transactions on Aerospace and Electronic Systems.

[19]  Guoquan Huang,et al.  Visual-Inertial Navigation: A Concise Review , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[20]  Changbin Yu,et al.  A Dual Quaternion Solution to Attitude and Position Control for Rigid-Body Coordination , 2012, IEEE Transactions on Robotics.

[21]  M. B. Ignagni,et al.  Optimal strapdown attitude integration algorithms , 1990 .

[22]  Mario Ignagni,et al.  Enhanced Strapdown Attitude Computation , 2020, Journal of Guidance, Control, and Dynamics.

[23]  Dewen Hu,et al.  Strapdown inertial navigation system algorithms based on dual quaternions , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[24]  P. Groves Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[25]  Changbin Yu,et al.  The geometric structure of unit dual quaternion with application in kinematic control , 2012 .

[26]  Federico Thomas,et al.  Approaching Dual Quaternions From Matrix Algebra , 2014, IEEE Transactions on Robotics.

[27]  J. Bortz A New Mathematical Formulation for Strapdown Inertial Navigation , 1971, IEEE Transactions on Aerospace and Electronic Systems.

[28]  Yuanxin Wu,et al.  RodFIter: Attitude Reconstruction From Inertial Measurement by Functional Iteration , 2017, IEEE Transactions on Aerospace and Electronic Systems.

[29]  J. Grizzle,et al.  Contact-aided invariant extended Kalman filtering for robot state estimation , 2019, Int. J. Robotics Res..

[30]  J. D. Everett A Treatise on the Theory of Screws , 1901, Nature.

[31]  P. Savage A Unified Mathematical Framework for Strapdown Algorithm Design , 2006 .

[32]  J. W. Jordan An accurate strapdown direction cosine algorithm , 1969 .

[33]  Panagiotis Tsiotras,et al.  Pose tracking without linearand angular-velocity feedback using dual quaternions , 2016, IEEE Transactions on Aerospace and Electronic Systems.

[34]  Russell H. Taylor,et al.  On homogeneous transforms, quaternions, and computational efficiency , 1990, IEEE Trans. Robotics Autom..

[35]  MULTIDUAL NUMBERS AND THEIR MULTIDUAL FUNCTIONS , 2015 .

[36]  D. Condurache Multidual Algebra and Higher-Order Kinematics , 2020 .

[37]  Juan J. Alonso,et al.  Automatic Differentiation Through the Use of Hyper-Dual Numbers for Second Derivatives , 2012 .

[38]  P. Savage STRAPDOWN INERTIAL NAVIGATION INTEGRATION ALGORITHM DESIGN. PART 2: VELOCITY AND POSITION ALGORITHMS , 1998 .

[39]  Moshe Shoham,et al.  Hyper Dual Quaternions representation of rigid bodies kinematics , 2020 .

[40]  J. Alonso,et al.  The Development of Hyper-Dual Numbers for Exact Second-Derivative Calculations , 2011 .

[41]  Panagiotis Tsiotras,et al.  Dual Quaternions as a Tool for Modeling, Control, and Estimation for Spacecraft Robotic Servicing Missions , 2020, The Journal of the Astronautical Sciences.

[42]  John L. Crassidis,et al.  Fundamentals of Spacecraft Attitude Determination and Control , 2014 .

[43]  Yuanxin Wu,et al.  Attitude Reconstruction From Inertial Measurements: QuatFIter and Its Comparison with RodFIter , 2019, IEEE Transactions on Aerospace and Electronic Systems.

[44]  P. Alam,et al.  R , 1823, The Herodotus Encyclopedia.