Even Order Explicit Symplectic Geometric Algorithms for Solving Quaternions in Guidance Navigation and Control via Diagonal Padé Approximation and Cayley Transform

Hong-Yan Zhang,Fei Liu,Yu Zhou,Man Liang
DOI: https://doi.org/10.1109/ACCESS.2024.3433478
2024-08-07
Abstract:Quaternion kinematical differential equation (QKDE) plays a key role in navigation, control and guidance systems. Although explicit symplectic geometric algorithms (ESGA) for this problem are available, there is a lack of a unified way for constructing high order symplectic difference schemes with configurable order parameter and the fractional interval sampling problem should be treated carefully. We present even order explicit symplectic geometric algorithms to solve the QKDE with diagonal Padé approximation via a four-step strategy. Firstly, the Padé-Cayley lemma is proved and used to simplify the symplectic Padé approximation for the linear Hamiltonian system with infinitesimal symplectic structure. Secondly, both parallel and alternative iterative methods are proposed to construct the symplectic difference schemes with even order accuracy. Thirdly, the symplecity, orthogonality and invertibility of the single-step transition matrices are proved rigorously. Finally, the explicit symplectic geometric algorithms are designed for both the linear time-invariant and linear time-varying QKDE. The maximum absolute error for solving the QKDE is $\mathcal{O}((t_f-t_0)\tau^{2\ell})$ where $\tau$ is the time step, $\ell$ is the order parameter and $[t_0,t_f]$ is the time span. The linear time complexity and constant space complexity of computation as well as the simple algorithmic structure show that our algorithms are appropriate for real-time applications in aeronautics, astronautics, robotics and so on. The performance of the proposed algorithms are verified and validated by mathematical analysis and numerical simulation.
Systems and Control,Symplectic Geometry
What problem does this paper attempt to address?
### Problems the paper attempts to solve The paper aims to solve the numerical solution problem of quaternion kinematic differential equations (QKDE) in navigation, control and guidance systems. Specifically, the paper focuses on the following aspects: 1. **Construction of high - order explicit symplectic geometric algorithms (ESGA)**: - Existing ESGA methods lack a unified way to construct high - order symplectic difference schemes (SDS) with configurable order parameters, and need to carefully handle the fractional - interval sampling problem. - The paper proposes an even - order explicit symplectic geometric algorithm (EoESGA) based on diagonal Padé approximation and Cayley transformation to solve these problems. 2. **Numerical stability and accuracy**: - The quaternion kinematic differential equation (QKDE) is a linear ordinary differential equation (ODE), but its analytical solution is difficult to find, especially when the angular velocity vector \(\omega(t)\) changes over time. - QKDE is very sensitive to computational errors during long - time integration, so it is necessary to find a numerical integration method that is both stable and accurate over a long time. 3. **Requirements for real - time applications**: - Existing high - order symplectic methods have high computational complexity and are not suitable for real - time applications. - Low - order non - configurable explicit symplectic geometric algorithms (ESGA) have difficulties in dealing with high - speed moving objects (such as missiles and fourth - or fifth - generation fighter jets), and also have additional difficulties in hardware implementation. ### Solutions The paper proposes the even - order explicit symplectic geometric algorithm (EoESGA) through the following steps: 1. **Prove the Padé - Cayley lemma**: - Use the Padé - Cayley lemma to simplify the diagonal Padé approximation of the linear Hamiltonian system. 2. **Construct the symplectic difference scheme**: - Propose parallel and alternating iterative methods to construct a symplectic difference scheme with even - order accuracy. 3. **Prove the properties of the single - step transition matrix**: - Rigorously prove the symplecticity, orthogonality and invertibility of the single - step transition matrix. 4. **Design the explicit symplectic geometric algorithm**: - Design an explicit symplectic geometric algorithm suitable for linear time - invariant QKDE (LTI - QKDE) and linear time - varying QKDE (LTV - QKDE). 5. **Analyze the computational complexity**: - Analyze the time complexity and space complexity of the algorithm to ensure that the algorithm is suitable for real - time applications. 6. **Performance evaluation**: - Verify the performance of the proposed algorithm through mathematical analysis and numerical simulation. ### Key contributions - **Unified method**: Provides a unified method to construct high - order symplectic difference schemes with configurable order parameters. - **Numerical stability**: Ensures that the algorithm maintains numerical stability and accuracy during long - time integration. - **Real - time applicability**: The algorithm has linear time complexity and constant space complexity, and is suitable for real - time applications. Through these contributions, the paper provides new methods and tools for the efficient numerical solution of quaternion kinematic differential equations in navigation, control and guidance systems.