Multi-gyroscope redundant resonant gyroscope inertial navigation drift online estimation method, system and device
By employing a multi-gyroscope redundancy architecture and online estimation methods, the problem of uneven gyroscope stiffness caused by resonator cracks was solved, enabling high-precision drift estimation and real-time compensation for the gyro inertial navigation system, thereby improving the gyroscope's lifespan and output accuracy.
Patent Information
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-02-10
- Publication Date
- 2026-03-17
AI Technical Summary
In the existing technology, due to the limitations of the manufacturing process of the resonator, the resonator may develop micro-cracks, resulting in uneven stiffness and damping of the gyroscope, which affects the service life and output accuracy of the gyroscope.
A multi-gyroscope redundancy architecture is adopted. The gyroscope state is monitored by least squares estimation and Kalman filtering. The drift estimation and compensation are performed by the transformation matrix between inertial navigation systems, so as to realize online estimation and real-time correction of the gyroscope inertial navigation system.
It improves the output accuracy of gyroscopes, reduces drift accumulation caused by cracks, enhances the lifespan and accuracy of inertial measurement units, and provides drift estimation methods that adapt to different accuracy requirements.
Smart Images

Figure CN121677778A_ABST
Abstract
Description
Technical Field
[0001] This invention relates to the field of gyroscope drift estimation technology, and in particular to an online method, system, and device for estimating drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system. Background Technology
[0002] In existing technologies, due to limitations in current manufacturing processes, micro-cracks can develop on the lip, hemispherical shell surface, and support rod of the resonator. When the resonator vibrates, the size and distribution of these cracks may change, affecting the gyroscope's lifespan. These cracks also affect the resonator's stiffness and leave residual internal stress; the uneven distribution of cracks leads to uneven distribution of residual internal stress, resulting in inconsistent stiffness and damping at different locations within the resonator. Summary of the Invention
[0003] This invention aims to at least solve one of the technical problems existing in related technologies. To this end, this invention provides a method, system, and apparatus for online estimation of drift in a multi-gyroscope redundant resonant gyroscope inertial navigation system, thereby improving the accuracy of gyroscope output.
[0004] This invention provides an online estimation method for drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system, comprising the following steps: S1: Divide the gyroscope inertial group into two inertial groups, inertial group A and inertial group B, monitor the gyroscope state, and set the gyroscope inertial group that provides the input to pure full-angle mode to provide the output of the estimated gyroscope inertial group; S2: Control the estimated gyroscope inertial navigation system to stay at different array angles, and perform drift estimation on the estimated gyroscope inertial navigation system; S3: Set the estimated gyro inertial group to pure full-angle mode as the gyro inertial group to provide input, return to step S2, estimate another gyro inertial group, and complete the drift estimation.
[0005] According to the present invention, a method for online estimation of drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system is provided, wherein step S1 includes: S11: Calculate the estimated angular velocity of the carrier for all gyro inertial navigation systems using least squares estimation; S12: Project all gyroscope inertial navigation systems onto a fixed orthogonal coordinate system and calculate the transformation matrix between the inertial navigation systems; S13: Obtain the estimated angular velocity of one gyroscope inertial navigation system, input the estimated value into the transformation matrix to calculate the output representation of the remaining gyroscopes.
[0006] According to the present invention, a method for online estimation of drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system is provided, wherein step S11 includes the following steps: S111: For an inertial navigation system using n single-degree-of-freedom gyroscopes, the measurement input of the gyroscopes is expressed by the following formula: in, For measurement vectors; To configure the matrix; The angular velocity of the carrier; This is the gyroscope drift vector; S112: Based on the least squares estimation theory, the estimated value of the carrier's angular velocity is obtained. : in, For matrix transpose, This is the characteristic matrix.
[0007] According to the present invention, a method for online estimation of drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system is provided, wherein step S12 includes the following steps: Divide all gyroscope inertial groups into two inertial groups and project them onto a fixed orthogonal coordinate system. Calculate the transformation matrix between the inertial groups and the orthogonal coordinate system B: in, This outputs the angular velocity in the x-direction of an orthogonal coordinate system. This outputs the angular velocity in the y-direction of an orthogonal coordinate system. Angular velocity output in the z-direction of an orthogonal coordinate system. Let be the transformation matrix from inertial navigation system A to system B. This refers to the gyroscope output in the x-direction of inertial navigation system A. This refers to the gyroscope output in the y-direction of inertial navigation system A. This refers to the gyroscope output in the z-direction of inertial navigation system A. This refers to the gyro drift in the x-direction of inertial navigation system A. This represents the gyro drift in the y-direction of inertial navigation system A. This refers to the gyro drift in the z-direction of inertial navigation system A. Let be the transformation matrix from inertial navigation system B to system B. This refers to the gyroscope output in the x-direction of inertial navigation system B. This refers to the gyroscope output in the y-direction of inertial navigation system B. This refers to the gyroscope output in the z-direction of inertial navigation system B. This refers to the gyro drift in the x-direction within inertial navigation system B. This represents the gyro drift in the y-direction of inertial navigation system B. This refers to the gyro drift in the z-direction within inertial navigation system B. Since the non-orthogonal error angle of the gyroscope within one inertial navigation system and the non-parallelism error angle between two inertial navigation systems are less than 1°, the formula can be rewritten as: .
[0008] According to the present invention, a method for online estimation of drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system is provided, wherein step S2 includes: S21: When estimating the drift of inertial group A, control inertial group B to be in pure full-angle mode. The mode shape precession of the gyroscope of inertial group A to different mode shape angles will induce drift changes. S22: Determine the number of low-order drift terms based on the drift changes, and select the corresponding formation angle based on the number of low-order drift terms; S23: By controlling the mode shape, the mode shape of gyroscope A is controlled to stay at different mode shape angles, while gyroscope B is always in full-angle mode. The drift value of gyroscope A is estimated online using the drift estimation method.
[0009] According to the present invention, a method for online estimation of drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system is provided. Step S22 includes the following steps: the number of low-order drift terms includes 1 zero-order term, 2 first-order terms, and 2 second-order terms, with corresponding array angles of 0°, 18°, 36°, 52°, and 72°.
[0010] According to the present invention, an online drift estimation method for a multi-gyroscope redundant resonant gyroscope inertial navigation system is provided, wherein the drift estimation method includes the least squares method and the Kalman filter method.
[0011] This invention also provides an online drift estimation system for multi-gyroscope redundant resonant gyroscope inertial navigation, comprising: Gyroscope output representation acquisition module: Divides the gyroscope inertial group into two inertial groups, inertial group A and inertial group B, monitors the gyroscope state, sets the input gyroscope inertial group to pure full-angle mode, and provides the output of the estimated gyroscope inertial group; Drift estimation module: controls the estimated gyroscope inertial group to stay at different array angles, and performs drift estimation on the estimated gyroscope inertial group; Rotation estimation module: Set the estimated gyro inertial group to pure full-angle mode, use it as the input gyro inertial group, return to the drift estimation module, estimate another gyro inertial group, and complete the drift estimation.
[0012] The present invention also provides an electronic device, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the program to implement the steps of the online estimation method for drift of a multi-gyroscope redundant resonant gyroscope inertial navigation as described above.
[0013] The above-described one or more technical solutions in the embodiments of the present invention have at least one of the following technical effects: This invention provides an online drift estimation method for multi-gyroscope redundant resonant gyroscopes and inertial navigation systems. Based on a multi-gyroscope redundancy architecture, a drift estimation method for hemispherical resonant gyroscopes is proposed, achieving the following advantages: 1. The core advantage of this solution is that it enables online estimation and real-time compensation of gyroscope drift, directly solving the drift problem caused by uneven damping or stiffness of hemispherical resonant gyroscopes due to process defects such as cracks, and significantly improving the output accuracy of the inertial measurement unit (INS).
[0014] 2. To address the limitations of HRG manufacturing processes, which lead to drift that varies with the position of the standing wave, this solution uses a multi-gyroscope redundant architecture for mutual monitoring and drift estimation to offset the performance degradation caused by this inherent defect. This allows the long lifespan advantage of HRG to be fully utilized and avoids a decrease in system accuracy due to drift accumulation.
[0015] 3. This solution specifically corrects five low-order drift parameters, making the estimation more targeted and the correction effect better. It selects a low-dynamic environment for drift estimation, which effectively reduces the impact of non-target errors such as scaling error and installation error on the drift estimation results. At the same time, this solution does not limit the drift estimation method and can select high-precision algorithms such as least squares and Kalman filtering according to the actual scenario to adapt to different accuracy requirements.
[0016] Additional aspects and advantages of the invention will be set forth in part in the description which follows, and in part will be obvious from the description, or may be learned by practice of the invention. Attached Figure Description
[0017] To more clearly illustrate the technical solutions in this invention or the prior art, the drawings used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the drawings described below are some embodiments of this invention. For those skilled in the art, other drawings can be obtained from these drawings without creative effort.
[0018] Figure 1 This is a flowchart illustrating an online estimation method for drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system provided by the present invention.
[0019] Figure 2 It consists of two sets of parallel, three-orthogonal six-gyroscope architectures.
[0020] Figure 3 Configure the architecture for two sets of parallel quad gyroscopes.
[0021] Figure 4 This is a schematic diagram of the drift process results.
[0022] Figure 5 This is a block diagram of an online drift estimation system for multi-gyroscope redundant resonant gyroscope inertial navigation provided by the present invention.
[0023] Figure 6 This is a schematic diagram of the electronic device provided by the present invention.
[0024] Figure label: 810, Processor; 820, Communication interface; 830, Memory; 840, Communication bus. Detailed Implementation
[0025] To make the objectives, technical solutions, and advantages of this invention clearer, the technical solutions of this invention will be clearly and completely described below. Obviously, the described embodiments are only some, not all, of the embodiments of this invention. Based on the embodiments of this invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of this invention. The following embodiments are used to illustrate this invention but cannot be used to limit the scope of this invention.
[0026] In the description of this specification, the references to terms such as "one embodiment," "some embodiments," "example," "specific example," or "some examples," etc., refer to specific features, structures, materials, or characteristics described in connection with that embodiment or example, which are included in at least one embodiment or example of the present invention. In this specification, the illustrative expressions of the above terms do not necessarily refer to the same embodiment or example. Furthermore, the specific features, structures, materials, or characteristics described may be combined in any suitable manner in one or more embodiments or examples. Moreover, without contradiction, those skilled in the art can combine and integrate the different embodiments or examples described in this specification, as well as the features of different embodiments or examples.
[0027] The following is combined with Figures 1 to 6 This invention is described.
[0028] Example Due to limitations in current manufacturing processes, micro-cracks may develop on the lip, hemispherical shell surface, and support rod of the resonator. When the resonator vibrates, the size and distribution of these cracks may change, affecting the gyroscope's lifespan. These cracks also affect the resonator's stiffness and leave residual internal stress; uneven crack distribution leads to uneven residual internal stress distribution, resulting in inconsistent stiffness and damping at different locations within the resonator. Multi-gyroscope redundancy structures include, but are not limited to, two sets of parallel tri-orthogonal six-gyroscope architectures and four-gyroscope configurations. The two sets of parallel tri-orthogonal six-gyroscope architectures are as follows: Figure 2 As shown. The four gyroscopes are configured as follows. Figure 3 (a) and Figure 3 As shown in (b).
[0029] Inconsistent damping at different positions in a hemispherical resonant gyroscope can cause the gyroscope to exhibit behavior that varies with the position of the standing wave. The changing drift, which can be represented by a Fourier series. Expand, represented as Indicates drift The magnitude of the item, Indicates drift The magnitude of the item, This refers to the number of expansions. Generally speaking... The larger the value, the smaller the coefficient of this term. For every 1 increase, the coefficient of this term decreases by an order of magnitude. Therefore, the drift is mainly affected by the lower-order terms of the Fourier series expansion. In general, it is mainly affected by the first and second order drifts. n is the number of degrees of freedom of the gyroscope.
[0030] like Figure 1 As shown, this invention proposes an online estimation method for drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system, comprising the following steps: S1: Divide the gyroscope inertial group into two inertial groups, inertial group A and inertial group B, monitor the gyroscope state, and set the gyroscope inertial group that provides the input to pure full-angle mode to provide the output of the estimated gyroscope inertial group; S2: Control the estimated gyroscope inertial navigation system to stay at different array angles, and perform drift estimation on the estimated gyroscope inertial navigation system; S3: Set the estimated gyro inertial group to pure full-angle mode as the gyro inertial group to provide input, return to step S2, estimate another gyro inertial group, and complete the drift estimation.
[0031] by Figure 2 Taking the six-gyroscope architecture shown as an example, inertial navigation systems A and B are usually calibrated in advance.
[0032] Specifically, step S1 includes: S11: Calculate the estimated angular velocity of the carrier for all gyro inertial navigation systems using least squares estimation; S12: Project all gyroscope inertial navigation systems onto a fixed orthogonal coordinate system and calculate the transformation matrix between the inertial navigation systems; S13: Obtain the estimated angular velocity of one gyroscope inertial navigation system, input the estimated value into the transformation matrix to calculate the output representation of the remaining gyroscopes.
[0033] Specifically, step S11 includes the following steps: S111: For an inertial navigation system using n single-degree-of-freedom gyroscopes, the measurement input of the gyroscopes can be expressed by the following formula: in, For measurement vectors; To configure the matrix; The angular velocity of the carrier; This is the gyroscope drift vector; S112: According to the least squares estimation theory, the angular velocity of the carrier can be obtained. The estimated value : in, For matrix transpose, This is the characteristic matrix.
[0034] Specifically, step S12 includes the following steps: Projecting all gyroscope inertial navigation systems (INS) onto a fixed orthogonal coordinate system B, the transformation matrix between the INS and the orthogonal coordinate system B is calculated: in, This outputs the angular velocity in the x-direction of an orthogonal coordinate system. This outputs the angular velocity in the y-direction of an orthogonal coordinate system. Angular velocity output in the z-direction of an orthogonal coordinate system. Let be the transformation matrix from inertial navigation system A to system B. This refers to the gyroscope output in the x-direction of inertial navigation system A. This refers to the gyroscope output in the y-direction of inertial navigation system A. This refers to the gyroscope output in the z-direction of inertial navigation system A. This refers to the gyro drift in the x-direction of inertial navigation system A. This represents the gyro drift in the y-direction of inertial navigation system A. This refers to the gyro drift in the z-direction of inertial navigation system A. Let be the transformation matrix from inertial navigation system B to system B. This refers to the gyroscope output in the x-direction of inertial navigation system B. This refers to the gyroscope output in the y-direction of inertial navigation system B. This refers to the gyroscope output in the z-direction of inertial navigation system B. This refers to the gyro drift in the x-direction within inertial navigation system B. This represents the gyro drift in the y-direction of inertial navigation system B. This refers to the gyro drift in the z-direction within inertial navigation system B. Since the non-orthogonal error angle of the gyroscope within one inertial navigation system and the non-parallelism error angle between two inertial navigation systems are less than 1°, the formula can be rewritten as: .
[0035] Taking inertial group B monitoring inertial group A as an example, by rearranging the terms of the equation, the gyroscope monitoring error can be expressed as: All quantities on the right side of the equation are known quantities. Estimating the gyroscope monitoring error means estimating the gyroscope drift.
[0036] During drift estimation, inertial navigation systems (INS) A and INS B can serve as mutual references to ensure continuous INS output. While INS A performs drift estimation, INS B provides the angular velocity output of the INS.
[0037] To minimize the impact of other system errors (such as scaling and installation errors) on drift estimation, drift estimation must be performed in a low-dynamic environment. Drift estimation is performed in two steps: first, the drift of inertial group A is estimated, and second, the drift of inertial group B is estimated.
[0038] Specifically, step S2 includes: S21: When estimating the drift of inertial group A, control inertial group B to be in pure full-angle mode. The mode shape precession of the gyroscope of inertial group A to different mode shape angles will induce drift changes. S22: Determine the number of low-order drift terms based on the drift changes, and select the corresponding formation angle based on the number of low-order drift terms; S23: By controlling the mode shape, the gyroscope of inertial group A is controlled to remain at different mode shape angles, while the gyroscope of inertial group B is always in full-angle mode. The drift value of inertial group A is estimated online using drift estimation methods. The drift estimation methods include the least squares method and the Kalman filter method.
[0039] Specifically, such as Figure 4 As shown, inertial navigation systems (INS) A and B alternately perform drift estimation, and after completing the estimation, they perform drift compensation. Then, the two INS systems jointly provide INS output angular velocity information. Before time T1, INS A performs drift estimation, while INS B is in full-angle mode and provides INS output. The opposite occurs between time T1 and T2. Between time T2 and T3, both INS systems complete the correction and provide normal output.
[0040] like Figure 5 As shown below, an online drift estimation system for multi-gyroscope redundant resonant gyroscope inertial navigation provided by the present invention will be described. The online drift estimation system for multi-gyroscope redundant resonant gyroscope inertial navigation described below can be referred to in correspondence with the online drift estimation method for multi-gyroscope redundant resonant gyroscope inertial navigation described above.
[0041] Gyroscope output representation acquisition module: Divides the gyroscope inertial group into two inertial groups, inertial group A and inertial group B, monitors the gyroscope state, sets the input gyroscope inertial group to pure full-angle mode, and provides the output of the estimated gyroscope inertial group; Drift estimation module: controls the estimated gyroscope inertial group to stay at different array angles, and performs drift estimation on the estimated gyroscope inertial group; Rotation estimation module: Set the estimated gyro inertial group to pure full-angle mode, use it as the input gyro inertial group, return to the drift estimation module, estimate another gyro inertial group, and complete the drift estimation.
[0042] Figure 6 An example is a schematic diagram of the physical structure of an electronic device, such as... Figure 6 As shown, the electronic device may include: a processor 810, a communication interface 820, a memory 830, and a communication bus 840, wherein the processor 810, the communication interface 820, and the memory 830 communicate with each other via the communication bus 840. The processor 810 can call logic instructions in the memory 830 to execute an online estimation method for drift of a multi-gyroscope redundant resonant gyroscope inertial navigation system, the method including: S1: Divide the gyroscope inertial group into two inertial groups, inertial group A and inertial group B, monitor the gyroscope state, and set the gyroscope inertial group that provides the input to pure full-angle mode to provide the output of the estimated gyroscope inertial group; S2: Control the estimated gyroscope inertial navigation system to stay at different array angles, and perform drift estimation on the estimated gyroscope inertial navigation system; S3: Set the estimated gyro inertial group to pure full-angle mode as the gyro inertial group to provide input, return to step S2, estimate another gyro inertial group, and complete the drift estimation.
[0043] Furthermore, the logical instructions in the aforementioned memory 830 can be implemented as software functional units and, when sold or used as independent products, can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, essentially, or the part that contributes to the prior art, or a part of the technical solution, can be embodied in the form of a software product. This computer software product is stored in a storage medium and includes several instructions to cause a computer device (which may be a personal computer, server, or network device, etc.) to execute all or part of the steps of the methods described in the various embodiments of the present invention. The aforementioned storage medium includes various media capable of storing program code, such as USB flash drives, portable hard drives, read-only memory (ROM), random access memory (RAM), magnetic disks, or optical disks.
[0044] The device embodiments described above are merely illustrative. The units described as separate components may or may not be physically separate. The components shown as units may or may not be physical units; that is, they may be located in one place or distributed across multiple network units. Some or all of the modules can be selected to achieve the purpose of this embodiment according to actual needs. Those skilled in the art can understand and implement this without any creative effort.
[0045] Through the above description of the embodiments, those skilled in the art can clearly understand that each embodiment can be implemented by means of software plus necessary general-purpose hardware platforms, and of course, it can also be implemented by hardware. Based on this understanding, the above technical solutions, in essence or the part that contributes to the prior art, can be embodied in the form of a software product. This computer software product can be stored in a computer-readable storage medium, such as ROM / RAM, magnetic disk, optical disk, etc., and includes several instructions to cause a computer device (which may be a personal computer, server, or network device, etc.) to execute the methods described in the various embodiments or some parts of the embodiments.
[0046] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention, and not to limit them; although the present invention has been described in detail with reference to the foregoing embodiments, those skilled in the art should understand that modifications can still be made to the technical solutions described in the foregoing embodiments, or equivalent substitutions can be made to some of the technical features; and these modifications or substitutions do not cause the essence of the corresponding technical solutions to deviate from the spirit and scope of the technical solutions of the embodiments of the present invention.
[0047] It should be noted that the embodiments of this disclosure can be implemented using hardware, software, or a combination of both. The hardware portion can be implemented using dedicated logic; the software portion can be stored in memory and executed by a suitable instruction execution system, such as a microprocessor or dedicated-design hardware. Those skilled in the art will understand that the above-described apparatus and methods can be implemented using computer-executable instructions and / or included in processor control code, for example, such code provided on a programmable memory or a data carrier such as an optical or electronic signal carrier.
[0048] Furthermore, although the operation of the methods of this disclosure is described in a specific order in the accompanying drawings, this does not require or imply that these operations must be performed in that specific order, or that all the operations shown must be performed to achieve the desired result. Rather, the steps depicted in the flowcharts may be performed in a different order. Additionally or alternatively, certain steps may be omitted, multiple steps may be combined into one step, and / or one step may be broken down into multiple steps. It should also be noted that the features and functions of two or more devices according to this disclosure may be embodied in one device. Conversely, the features and functions of one device described above may be further divided and embodied by multiple devices.
[0049] While this disclosure has been described with reference to several specific embodiments, it should be understood that this disclosure is not limited to the specific embodiments disclosed. This disclosure is intended to cover various modifications and equivalent arrangements included within the spirit and scope of the appended claims.
Claims
1. A multi-gyroscope redundant resonator gyro inertial navigation drift online estimation method, characterized in that, The method comprises the following steps: S1: divide the gyro inertial measurement unit into two inertial measurement units, i.e., inertial measurement unit A and inertial measurement unit B, monitor the gyro state, and set the gyro inertial measurement unit providing input to a pure full-angle mode for providing output of the estimated gyro inertial measurement unit; S2: control the estimated gyro inertial measurement unit to stay at different array angles, and estimate the drift of the estimated gyro inertial measurement unit; step S2 comprises: S21: when the drift of the inertial measurement unit A is estimated, control the inertial measurement unit B to be in the pure full-angle mode, and control the mode of the inertial measurement unit A to be at different mode angles, so as to excite the drift variation; S22: judge the number of low-order drift terms according to the drift variation, and select corresponding array angles according to the number of low-order drift terms; S23: control the mode of the inertial measurement unit A to stay at different mode angles through mode control, and control the mode of the inertial measurement unit B to be in the full-angle mode all the time, and estimate the drift value of the inertial measurement unit A on line by using the estimation method of drift estimation; S3: set the estimated gyro inertial measurement unit to the pure full-angle mode, as the gyro inertial measurement unit providing input, return to step S2, estimate another gyro inertial measurement unit, and complete the drift estimation.
2. The method according to claim 1, wherein, Step S1 comprises: S11: calculate the carrier angular velocity estimation value of all gyro inertial measurement units by using least square estimation; S12: project all gyro inertial measurement units to a fixed orthogonal coordinate system, and calculate the conversion matrix between the gyro inertial measurement units; S13: obtain the carrier angular velocity estimation value of a gyro inertial measurement unit, and input the estimation value into the conversion matrix to obtain the output representation of the remaining gyro.
3. The method according to claim 1, wherein, Step S11 comprises the following steps: S111: for the inertial measurement unit using n single-degree-of-freedom gyroscopes, the measurement input of the gyroscopes is expressed by the following formula: wherein, is a measurement vector; is a configuration matrix; is a carrier angular velocity; is a gyro drift vector; S112: Obtain the estimated value of the carrier angular velocity according to the least square estimation theory : wherein, is the matrix transpose, is the feature matrix.
4. The method according to claim 3, wherein, Step S12 comprises the following steps: divide the gyro inertial measurement unit into two inertial measurement units, and project the two inertial measurement units to a fixed orthogonal coordinate system, and calculate the conversion matrix between the inertial measurement units and the orthogonal coordinate system: wherein is an angular velocity output of the x-direction of the orthogonal coordinate system, is an angular velocity output of the y-direction of the orthogonal coordinate system, is an angular velocity output of the z-direction of the orthogonal coordinate system, is a conversion matrix of the inertial group A to the B system, is a gyro output of the x-direction in the inertial group A, is a gyro output of the y-direction in the inertial group A, is a gyro output of the z-direction in the inertial group A, is a gyro drift of the x-direction in the inertial group A, is a gyro drift of the y-direction in the inertial group A, is a gyro drift of the z-direction in the inertial group A, is a conversion matrix of the inertial group B to the B system, is a gyro output of the x-direction in the inertial group B, is a gyro output of the y-direction in the inertial group B, is a gyro output of the z-direction in the inertial group B, is a gyro drift of the x-direction in the inertial group B, is a gyro drift of the y-direction in the inertial group B, is a gyro drift of the z-direction in the inertial group B; Since the non-orthogonal error angle of the gyroscopes in one inertial measurement unit and the non-parallel error angle between the two inertial measurement units are less than 1°, the formula is rewritten as: 。 5. The method of claim 1, wherein, Step S22 comprises the following steps: the number of low-order drift terms comprises one zero-order term, two first-order terms, and two second-order terms, and the corresponding array angles are 0°, 18°, 36°, 52°, and 72°.
6. The method according to claim 5, wherein, The estimation method of the drift estimation comprises least square method and Kalman filtering method.
7. A multi-gyroscope redundant resonator gyro inertial navigation drift on-line estimation system for implementing a multi-gyroscope redundant resonator gyro inertial navigation drift on-line estimation method as claimed in any one of claims 1 to 6, characterized in that, It comprises: a gyro output representation acquisition module: divide the gyro inertial measurement unit into two inertial measurement units, i.e., inertial measurement unit A and inertial measurement unit B, monitor the gyro state, and set the gyro inertial measurement unit providing input to a pure full-angle mode for providing output of the estimated gyro inertial measurement unit; a drift estimation module: control the estimated gyro inertial measurement unit to stay at different array angles, and estimate the drift of the estimated gyro inertial measurement unit; a rotation estimation module: set the estimated gyro inertial measurement unit to the pure full-angle mode, as the gyro inertial measurement unit providing input, return to the drift estimation module, estimate another gyro inertial measurement unit, and complete the drift estimation. 8.An electronic device comprising a processor, a communication interface, a memory, and a communication bus, characterized in that, The processor executes the computer program to realize the steps of the multi-gyro redundant resonant gyro inertial navigation drift on-line estimation method according to any one of claims 1 to 6.
Citation Information
Patent Citations
Method applicable to single-point estimation of underwater navigation system for gyro drift
CN104776847A
Vibrating gyroscope measurement and control method and device based on vibration mode control
CN116026298A
Zero-bias drift real-time suppression and zero-bias stability improvement method for symmetric gyroscope
CN116698084A
Gyroscope drift error compensation method and device
CN120063332A
Shipborne two-axis stable turntable gyro drift compensation method
CN121163506A