Combined attitude determination method for UPF (user port function) algorithm optimized by DNA (deoxyribonucleic acid) algorithm
An algorithm and attitude determination technology, applied in attitude control, instrumentation, adaptive control, etc., can solve problems such as nonlinear noise and non-Gaussian of the system
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment Construction
[0079] Such as figure 1 Shown, the specific implementation steps of the present invention are as follows:
[0080] Step 1, using the inertial gyroscope to measure the inertial measurement data, using the gyroscope output data to compensate the inertial measurement data, and then obtaining the carrier attitude information through attitude calculation;
[0081] Preferably, using the gyro drift estimated by the information fusion algorithm to compensate ε in the inertial measurement data ω=K×V+ε+ζ.
[0082] Described step 1 specifically comprises the following steps:
[0083] Step 1.1. Set the initial pose as Calculate the initial attitude quaternion q(0) matrix:
[0084]
[0085] Step 1.2. Update the attitude quaternion matrix as:
[0086] q ( n + 1 ) = { cos Δφ 2 I + sin ...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 