A fault-tolerant navigation method and device for rockets

By employing data consistency judgment of master-slave inertial groups and verification with the Global Positioning System in the rocket navigation system, the problem of navigation calculation accuracy caused by low-cost MEMS inertial groups was solved, and accurate navigation was achieved in the event of inertial group failure.

CN114184191BActive Publication Date: 2024-11-15KUAIZHOU AEROSPACE TECHNOLOGY CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202111516275.7
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2021-12-09
Publication Date
2024-11-15
Estimated Expiration
2041-12-09

AI Technical Summary

Technical Problem

In current rocket navigation systems, the selection of backup inertial navigation systems has shifted from high-precision fiber optic inertial navigation systems and laser inertial navigation systems to low-cost MEMS inertial navigation systems, resulting in low accuracy of fault-tolerant navigation calculations.

Method used

A master inertial navigation system (INS) and a slave INS are employed. The master INS is a high-precision INS, while the slave INS is a low-cost MEMS INS. By acquiring angular increment and velocity increment information, the consistency of the master and slave INS data is determined, navigation calculations are performed, and the navigation data is verified using the Global Positioning System (GPS).

Benefits of technology

It improves the accuracy of fault-tolerant navigation calculations for rocket navigation, ensuring that accurate navigation data can still be obtained when the inertial navigation system malfunctions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114184191B_ABST
    Figure CN114184191B_ABST
Patent Text Reader

Abstract

The present invention relates to the field of rocket navigation technology, and in particular to a rocket fault-tolerant navigation method and device. The method is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and comprises the following steps: obtaining angular increment information and velocity increment information of the master inertial group and the slave inertial group within a preset sampling period respectively; judging whether gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, and obtaining a first judgment result; judging whether table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the velocity increment information of the master inertial group and the velocity increment information of the slave inertial group within the preset sampling period, and obtaining a second judgment result; navigating the rocket based on the first judgment result and the second judgment result, and then obtaining accurate navigation data for navigation when any of the master and slave inertial groups fails.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of rocket navigation technology, and in particular to a rocket fault-tolerant navigation method and device. Background Art

[0002] Rocket navigation uses the angular increment information of the velocity increment during the rocket movement provided by the inertial group device. In related technologies, fiber optic inertial groups, laser inertial groups, etc. are used as backup inertial groups. Currently, the selection of backup inertial groups has developed from high-precision fiber optic inertial groups and laser inertial groups to low-cost MEMS inertial groups.

[0003] However, the current fault-tolerant navigation calculation accuracy is not high.

[0004] Therefore, how to improve the accuracy of the rocket's fault-tolerant navigation calculations is a technical problem that needs to be solved urgently. Summary of the invention

[0005] In view of the above problems, the present invention is proposed to provide a rocket fault-tolerant navigation method and device that overcomes the above problems or at least partially solves the above problems.

[0006] In a first aspect, the present invention provides a rocket fault-tolerant navigation method, which is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and the master inertial group and the slave inertial group both include a gyroscope and an adding table, wherein the gyroscope is used to output angle increment information, and the adding table is used to output velocity increment information, and includes:

[0007] Respectively obtain the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period;

[0008] Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, determining whether the gyro data of the master inertial group and the gyro data of the slave inertial group within the preset sampling period are consistent, and obtaining a first determination result;

[0009] Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, determining whether the added table data of the master inertia group and the slave inertia group within the preset sampling period are consistent, and obtaining a second determination result;

[0010] The rocket is navigated based on the first judgment result and the second judgment result.

[0011] Further, the determining whether the gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period to obtain the first determination result includes:

[0012] Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, obtaining a first difference between the modulus of the angular increment accumulated value of the master inertial group and the modulus of the angular increment accumulated value of the slave inertial group within the preset sampling period;

[0013] Determine whether the first difference satisfies an angle increment consistency determination threshold, and obtain a first determination sub-result;

[0014] Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, obtaining a first relationship between a vector angle of a cumulative value of the angular increment of the master inertial group and a vector angle of a cumulative value of the angular increment of the slave inertial group within the preset sampling period;

[0015] Determine whether the first relationship satisfies an angle increment angle threshold or a zero angle increment determination threshold, and obtain a second determination sub-result;

[0016] Based on the first judgment sub-result and the second judgment sub-result, a first judgment result is obtained.

[0017] Further, the determining whether the added table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the speed increment information of the master inertial group and the speed increment information of the slave inertial group within the preset sampling period to obtain the second determination result includes:

[0018] Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, obtaining a second difference between the modulus of the accumulated value of the speed increment of the master inertia group and the modulus of the accumulated value of the speed increment of the slave inertia group within the preset sampling period;

[0019] Determine whether the second difference satisfies a speed increment consistency determination threshold, and obtain a third determination sub-result;

[0020] Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, a second relationship between a vector angle of a speed increment cumulative value of the master inertia group and a vector angle of a speed increment cumulative value of the slave inertia group within the preset sampling period is obtained;

[0021] Determine whether the second relationship satisfies a speed increment angle threshold or a zero speed increment determination threshold, and obtain a fourth determination sub-result;

[0022] Based on the third judgment sub-result and the fourth judgment sub-result, a second judgment result is obtained.

[0023] Further, navigating the rocket based on the first judgment result and the second judgment result includes:

[0024] When both the first judgment result and the second judgment result are yes, obtaining a first calculation result according to the first navigation calculation based on the angular increment information and the velocity increment information of the main inertial group, wherein the first calculation result includes a velocity vector, a position vector, and an attitude vector of the rocket obtained based on the main inertial group;

[0025] Based on the first calculation result, the rocket is navigated.

[0026] Furthermore, before navigating the rocket based on the first calculation result, the method further includes:

[0027] The first calculation result is used to correct the second calculation result, wherein the second calculation result is a second calculation result obtained according to a second navigation calculation based on the angular increment information and the velocity increment information from the inertial group, and the second calculation result includes a velocity vector, a position vector and an attitude vector of the rocket obtained from the inertial group.

[0028] Further, navigating the rocket based on the first judgment result and the second judgment result includes:

[0029] When at least one of the first judgment result and the second judgment result is no, obtaining a first calculation result according to a first navigation calculation based on the angular increment information and the velocity increment information of the master inertial group, and obtaining a second calculation result according to a second navigation calculation based on the angular increment information and the velocity increment information of the slave inertial group;

[0030] Determine whether the first calculation result is normal, and obtain a third determination result;

[0031] Determine whether the second calculation result is normal, and obtain a fourth determination result;

[0032] When the third judgment result is yes, navigating the rocket based on the first calculation result;

[0033] When the third judgment result is no and the fourth judgment result is yes, navigating the rocket based on the second calculation result;

[0034] When the third judgment result is no and the fourth judgment result is no, a prompt indicating navigation abnormality is given.

[0035] Furthermore, the rocket navigation system further includes: a global satellite positioning system, and the determining whether the first calculation result is normal to obtain a third determination result includes:

[0036] Based on the third difference between the first value of the rocket's velocity vector at the end of the preset sampling period and the second value of the first period in the first calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end of the preset sampling period and the sixth value of the first period, whether the first calculation result is normal is determined to obtain a third judgment result;

[0037] The determining whether the second calculation result is normal to obtain a fourth determination result includes:

[0038] Based on the fourth difference between the third value of the rocket's velocity vector at the end period within the preset sampling period and the fourth value of the first period in the second calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end period within the preset sampling period and the sixth value of the first period, it is judged whether the second calculation result is normal to obtain a fourth judgment result.

[0039] In a second aspect, the present invention further provides a rocket fault-tolerant navigation device, which is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and the master inertial group and the slave inertial group both include a gyroscope and an adding table, wherein the gyroscope is used to output angle increment information, and the adding table is used to output velocity increment information, including:

[0040] An acquisition module is used to respectively acquire the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period;

[0041] A first judgment module is used to judge whether the gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, so as to obtain a first judgment result;

[0042] A second judgment module is used to judge whether the added table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the speed increment information of the master inertial group and the speed increment information of the slave inertial group within the preset sampling period, so as to obtain a second judgment result;

[0043] A navigation module is used to navigate the rocket based on the first judgment result and the second judgment result.

[0044] In a third aspect, the present invention further provides a computer device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above-mentioned method steps when executing the program.

[0045] In a fourth aspect, the present invention further provides a computer-readable storage medium having a computer program stored thereon, which implements the above method steps when executed by a processor.

[0046] One or more technical solutions in the embodiments of the present invention have at least the following technical effects or advantages:

[0047] The present invention provides a rocket fault-tolerant navigation method, which is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and the master inertial group and the slave inertial group both include a gyroscope and an add-on table, wherein the gyroscope is used to obtain angular increment information, and the add-on table is used to obtain velocity increment information, including respectively obtaining angular increment information and velocity increment information of the master inertial group and the slave inertial group within a preset sampling period; judging whether gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, and obtaining a first judgment result; judging whether add-on table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the velocity increment information of the master inertial group and the velocity increment information of the slave inertial group within the preset sampling period, and obtaining a second judgment result; navigating the rocket based on the first judgment result and the second judgment result, and then obtaining accurate navigation data for navigation when any of the master and slave inertial groups fails. BRIEF DESCRIPTION OF THE DRAWINGS

[0048] Various other advantages and benefits will become apparent to those of ordinary skill in the art by reading the detailed description of the preferred embodiments below. The accompanying drawings are only for the purpose of illustrating the preferred embodiments and are not to be considered as limiting the present invention. Also, throughout the accompanying drawings, the same reference figures are used to represent the same components. In the drawings:

[0049] Figure 1 A schematic diagram of the process flow of the rocket fault-tolerant navigation method according to an embodiment of the present invention is shown;

[0050] Figure 2 A schematic diagram of the structure of a rocket fault-tolerant navigation device in an embodiment of the present invention is shown;

[0051] Figure 3 A schematic diagram of the structure of a computer device for implementing a rocket fault-tolerant navigation method in an embodiment of the present invention is shown. DETAILED DESCRIPTION

[0052] The exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. Although the exemplary embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms and should not be limited by the embodiments set forth herein. On the contrary, these embodiments are provided to enable a more thorough understanding of the present disclosure and to fully convey the scope of the present disclosure to those skilled in the art.

[0053] Embodiment 1

[0054] The embodiment of the present invention provides a rocket fault-tolerant navigation method, which is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and both the master inertial group and the slave inertial group include a gyroscope and an adding table, wherein the gyroscope is used to obtain angle increment information, and the adding table is used to obtain velocity increment information, such as Figure 1 As shown, the method includes:

[0055] S101, respectively obtaining the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period;

[0056] S102, based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within a preset sampling period, determining whether the gyro data of the master inertial group and the gyro data of the slave inertial group within a preset sampling period are consistent, and obtaining a first determination result;

[0057] S103, based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, determining whether the added table data of the master inertia group and the slave inertia group within the preset sampling period are consistent, and obtaining a second determination result;

[0058] S104, navigating the rocket based on the first judgment result and the second judgment result.

[0059] In the hardware configuration of the rocket navigation system, two sets of inertial groups are used as backup for each other, including a master inertial group and a slave inertial group. The master inertial group includes gyroscope 1 and meter 1, which uses a high-precision inertial group, and the slave inertial group includes gyroscope 2 and meter 2, which uses a low-cost MEMS inertial group. In the rocket navigation system, a global satellite positioning system (GNSS) is also used to verify the inertial group navigation data.

[0060] S101, respectively obtaining the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period.

[0061] Specifically, starting from zero seconds after the rocket takes off, after P sampling cycles, for the Pth sampling cycle, the master inertial group and the slave inertial group output a set of inertial group data respectively, among which the gyro 1 output angle increment information of the master inertial group is Add Table 1 to output the speed increment information: The angular increment information output from the gyro 2 of the inertial unit is: Add Table 2 to output the speed increment information: Of course, the angular increment information and the velocity increment information of the master inertial group and the slave inertial group within a preset sampling period are obtained, and the preset sampling period includes the Pth sampling period and the N sampling periods before the Pth sampling period.

[0062] S102: Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within a preset sampling period, determine whether the gyro data of the master inertial group and the gyro data of the slave inertial group within the preset sampling period are consistent, and obtain a first determination result.

[0063] Specifically, in order to detect the consistency between the gyro data and the added table data of each inertial group in a preset sampling period, the following judgment needs to be made.

[0064] The consistency of the modulus of the gyro incremental cumulative value within the preset sampling period is judged, as well as the consistency of the vector angle of the gyro incremental cumulative value within the preset sampling period. The following two judgment conditions are required:

[0065] The first judgment condition is to obtain a first difference between the modulus of the angular increment accumulated value of the master inertial group and the modulus of the angular increment accumulated value of the slave inertial group within the preset sampling period based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, which is specifically as follows:

[0066]

[0067] Next, it is determined whether the first difference satisfies an angle increment consistency determination threshold, and a first determination sub-result is obtained.

[0068] Specifically, the first difference is compared with the gyro angle increment consistency judgment threshold, that is:

[0069]

[0070] Among them, ε ws is the gyro angle increment consistency judgment threshold.

[0071] When the first difference satisfies the angle increment consistency judgment threshold of the above formula, the first judgment sub-result indicates yes; otherwise, the first judgment sub-result indicates no.

[0072] The second judgment condition is that, based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, a first relationship between the vector angle of the angular increment cumulative value of the master inertial group and the vector angle of the angular increment cumulative value of the slave inertial group within the preset sampling period is obtained, which is specifically as follows:

[0073] or

[0074] Next, it is determined whether the first relationship satisfies an angle increment angle threshold or a zero angle increment determination threshold, and a second determination sub-result is obtained.

[0075] Specifically, it is to determine whether the first relationship satisfies the following relationship:

[0076] or

[0077] Among them, ε Wθ is the gyro angle increment angle threshold, ε W0 It is the threshold value for judging the gyro zero angle increment.

[0078] When any of the above relationship expressions is satisfied, the second judgment sub-result is yes, otherwise, the second judgment sub-result is no.

[0079] A first judgment result is obtained according to the first judgment sub-result and the second judgment sub-result.

[0080] The above is the process of judging the consistency of the gyro data of the master inertial group and the slave inertial group. Next, the consistency of the added table data of the master inertial group and the slave inertial group will be judged.

[0081] S103, based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, determine whether the added table data of the master inertia group and the slave inertia group within the preset sampling period are consistent, and obtain a second determination result.

[0082] Determine the consistency of the modulus of the accumulated value of the speed increment within the preset sampling period:

[0083] Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, a second difference between the modulus of the speed increment accumulated value of the master inertia group and the modulus of the speed increment accumulated value of the slave inertia group within the preset sampling period is obtained, which is specifically shown in the following formula:

[0084]

[0085] Next, it is determined whether the second difference satisfies the speed increment consistency determination threshold value to obtain a third determination sub-result.

[0086] Specifically, it is to determine whether the following relationship is satisfied:

[0087]

[0088] Among them, ε AS It is the increment consistency judgment threshold of the table speed.

[0089] When the second difference satisfies the above-mentioned table speed increment consistency judgment threshold, the third judgment sub-result is yes; otherwise, the third judgment sub-result is no.

[0090] It is also necessary to determine the consistency of the vector angle of the accumulated value of the added velocity increment within the preset sampling period:

[0091] Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, a second relationship between the vector angle of the speed increment cumulative value of the master inertia group and the vector angle of the speed increment cumulative value of the slave inertia group within the preset sampling period is obtained, which is specifically as follows:

[0092] or

[0093] Next, it is determined whether the second relationship satisfies a speed increment angle threshold or a zero speed increment determination threshold, and a fourth determination sub-result is obtained.

[0094] Specifically, it is to determine whether the second relationship satisfies the following relationship:

[0095] or

[0096] Among them, ε Aθ is the velocity increment angle threshold, ε A0 It is the threshold value for judging the zero speed increment.

[0097] When any of the above relationship expressions is satisfied, the fourth judgment sub-result is yes, otherwise, the fourth judgment sub-result is no.

[0098] Thus, based on the third judgment sub-result and the fourth judgment sub-result, the second judgment result is obtained.

[0099] Then, S104 is executed to navigate the rocket based on the first judgment result and the second judgment result.

[0100] Specifically, when both the first judgment result and the second judgment result are yes, a first calculation result according to the first navigation calculation is obtained based on the angular increment information and the velocity increment information of the main inertial group, and the first calculation result includes the velocity vector, position vector and attitude vector of the rocket obtained based on the main inertial group; based on the first calculation result, the rocket is navigated.

[0101] When both the first judgment result and the second judgment result are yes, it means that the consistency of the gyro data is good and the consistency of the added table data is good.

[0102] Correct the navigation error data from the inertial group (MEMS inertial group).

[0103] Specifically, the first calculation result is used to correct the second calculation result, wherein the second calculation result is a second calculation result obtained according to the second navigation calculation based on the angular increment information and the velocity increment information from the inertial group, and the second calculation result includes a velocity vector, a position vector and an attitude vector of the rocket obtained from the inertial group.

[0104] First, the second calculation result is corrected by the first calculation result according to the following formula:

[0105]

[0106]

[0107]

[0108] The velocity vector, position vector and attitude vector of the rocket in the first calculation result are used to correct the velocity vector, position vector and attitude vector of the rocket in the second calculation result respectively.

[0109] Then, the second calculation result after correction is As the starting point for navigation calculations, the gyro data from the inertial group is used And add table data Re-navigate to the current preset sampling period, thereby obtaining the corrected second calculation result.

[0110] The second calculation result is stored for subsequent use.

[0111] When at least one of the first judgment result and the second judgment result is negative, a first calculation result according to the first navigation calculation is obtained based on the angular increment information and the velocity increment information of the master inertial group, and a second calculation result according to the second navigation calculation is obtained based on the angular increment information and the velocity increment information of the slave inertial group;

[0112] Determine whether the first calculation result is normal, and obtain a third determination result;

[0113] Determine whether the second calculation result is normal, and obtain a fourth determination result;

[0114] When the third judgment result is yes, navigating the rocket based on the first calculation result;

[0115] When the third judgment result is no and the fourth judgment result is yes, navigating the rocket based on the second calculation result;

[0116] When the third judgment result is no and the fourth judgment result is no, a prompt indicating navigation abnormality is given.

[0117] When there is inconsistency in the consistency of the gyroscope data or the consistency of the added table data, it is necessary to determine whether the first calculation result and the second calculation result are normal.

[0118] Determining whether the first calculation result and the second calculation result are normal, the rocket navigation system further includes: a global satellite positioning system, and determining whether the first calculation result is normal to obtain a third determination result includes:

[0119] Based on the third difference between the first value of the rocket's velocity vector at the end period within the preset sampling period and the second value of the first period in the first calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end period within the preset sampling period and the sixth value of the first period, it is judged whether the first calculation result is normal to obtain a third judgment result.

[0120] Assume that the navigation calculation starts from zero seconds after takeoff and goes through P sampling cycles to reach the preset sampling cycle, that is, the Pth sampling cycle, and obtains the third difference between the first value of the rocket's velocity vector at the end cycle of the preset sampling cycle and the second value of the first cycle in the first calculation result, and the fifth difference between the fifth value of the end cycle of the global satellite positioning system within the preset sampling cycle and the sixth value of the first cycle, so as to judge whether the first calculation result is normal and obtain the third judgment result.

[0121] The third difference:

[0122] Fifth difference:

[0123] Judgment condition 1: and

[0124] In the above formula, ε ΔV is the speed change consistency judgment threshold, ε V is the speed consistency judgment threshold.

[0125] When the judgment condition 1 is met, it is determined that the first calculation result is normal, otherwise the first calculation result is abnormal.

[0126] To determine whether the second calculation result is normal, the fourth difference between the third value of the rocket's velocity vector at the end period within the preset sampling period and the fourth value of the first period in the second calculation result is obtained, as well as the fifth difference between the fifth value of the global satellite positioning system at the end period within the preset sampling period and the sixth value of the first period, thereby determining whether the second calculation result is normal and obtaining the fourth judgment result.

[0127] Fourth difference:

[0128] Fifth difference:

[0129] Judgment condition 2: and

[0130] When the judgment condition 2 is met, it is determined that the second calculation result is normal, otherwise the second calculation result is abnormal.

[0131] When the first calculation result is normal, that is, when the third judgment result is yes, the rocket is navigated based on the first calculation result.

[0132] When the first calculation result is abnormal and the second calculation result is normal, that is, the third judgment result is no and the fourth judgment result is yes, the rocket is navigated based on the second calculation result.

[0133] When the first calculation result is abnormal and the second calculation result is also abnormal, that is, the third judgment result is no and the fourth judgment result is no, the first calculation result is still forced to be selected for navigation, but at the same time it is prompted that the navigation is abnormal.

[0134] One or more technical solutions in the embodiments of the present invention have at least the following technical effects or advantages:

[0135] The present invention provides a rocket fault-tolerant navigation method, which is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and the master inertial group and the slave inertial group both include a gyroscope and an add-on table, wherein the gyroscope is used to obtain angular increment information, and the add-on table is used to obtain velocity increment information, including respectively obtaining angular increment information and velocity increment information of the master inertial group and the slave inertial group within a preset sampling period; judging whether gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, and obtaining a first judgment result; judging whether add-on table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the velocity increment information of the master inertial group and the velocity increment information of the slave inertial group within the preset sampling period, and obtaining a second judgment result; navigating the rocket based on the first judgment result and the second judgment result, and then obtaining accurate navigation data for navigation when any of the master and slave inertial groups fails.

[0136] Embodiment 2

[0137] Based on the same inventive concept, an embodiment of the present invention further provides a rocket fault-tolerant navigation device, which is applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, such as Figure 2 As shown, including:

[0138] An acquisition module 201 is used to respectively acquire the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period;

[0139] A first judgment module 202 is used to judge whether the gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, and obtain a first judgment result;

[0140] The second judgment module 203 is used to judge whether the added table data of the master inertia group and the slave inertia group within the preset sampling period are consistent based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, so as to obtain a second judgment result;

[0141] The navigation module 204 is used to navigate the rocket based on the first judgment result and the second judgment result.

[0142] In an optional implementation, the first determination module 202 includes:

[0143] a first obtaining unit, configured to obtain a first difference between a modulus of an angular increment cumulative value of the master inertial group and a modulus of an angular increment cumulative value of the slave inertial group within the preset sampling period based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period;

[0144] A first judgment unit, used to judge whether the first difference meets an angle increment consistency judgment threshold, and obtain a first judgment sub-result;

[0145] a second obtaining unit, configured to obtain, based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, a first relationship between a vector angle of a cumulative value of an angular increment of the master inertial group and a vector angle of a cumulative value of an angular increment of the slave inertial group within the preset sampling period;

[0146] A second judgment unit is used to judge whether the first relationship satisfies an angle increment angle threshold or a zero angle increment judgment threshold, and obtain a second judgment sub-result;

[0147] The third obtaining unit is configured to obtain a first judgment result based on the first judgment sub-result and the second judgment sub-result.

[0148] In an optional implementation, the second determination module 203 includes:

[0149] a fourth obtaining unit, configured to obtain a second difference between a modulus of a speed increment accumulated value of the master inertia group and a modulus of a speed increment accumulated value of the slave inertia group within the preset sampling period based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period;

[0150] A third judgment unit, used to judge whether the second difference meets a speed increment consistency judgment threshold, and obtain a third judgment sub-result;

[0151] A fifth obtaining unit is used to obtain a second relationship between a vector angle of a speed increment cumulative value of the master inertia group and a vector angle of a speed increment cumulative value of the slave inertia group within the preset sampling period based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period;

[0152] A fourth judgment unit, configured to judge whether the second relationship satisfies a speed increment angle threshold or a zero speed increment judgment threshold, and obtain a fourth judgment sub-result;

[0153] The sixth obtaining unit is configured to obtain a second judgment result based on the third judgment sub-result and the fourth judgment sub-result.

[0154] In an optional implementation, the navigation module 204 includes:

[0155] a first obtaining unit, configured to obtain, when both the first judgment result and the second judgment result are yes, a first calculation result according to the first navigation calculation based on the angular increment information and the velocity increment information of the main inertial group, wherein the first calculation result includes a velocity vector, a position vector, and an attitude vector of the rocket obtained based on the main inertial group;

[0156] A first navigation unit is used to navigate the rocket based on the first calculation result.

[0157] In an optional implementation, the navigation module 204 further includes: a correction unit for

[0158] The first calculation result is used to correct the second calculation result, wherein the second calculation result is a second calculation result obtained according to a second navigation calculation based on the angular increment information and the velocity increment information from the inertial group, and the second calculation result includes a velocity vector, a position vector and an attitude vector of the rocket obtained from the inertial group.

[0159] In an optional implementation, the navigation module 204 includes:

[0160] a seventh obtaining unit, configured to obtain, when at least one of the first judgment result and the second judgment result is negative, a first calculation result calculated according to the first navigation calculation based on the angular increment information and the velocity increment information of the master inertial group, and obtain a second calculation result calculated according to the second navigation calculation based on the angular increment information and the velocity increment information of the slave inertial group;

[0161] a fifth judgment unit, configured to judge whether the first calculation result is normal, and obtain a third judgment result;

[0162] a sixth judgment unit, configured to judge whether the second calculation result is normal, and obtain a fourth judgment result;

[0163] a second navigation unit, configured to navigate the rocket based on the first calculation result when the third judgment result is yes;

[0164] A third navigation unit, configured to navigate the rocket based on the second calculation result when the third judgment result is no and the fourth judgment result is yes;

[0165] The prompt unit is used to prompt navigation abnormality when the third judgment result is no and the fourth judgment result is no.

[0166] In an optional implementation manner, the fifth determination unit is configured to:

[0167] Based on the third difference between the first value of the rocket's velocity vector at the end of the preset sampling period and the second value of the first period in the first calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end of the preset sampling period and the sixth value of the first period, whether the first calculation result is normal is determined to obtain a third judgment result;

[0168] The sixth judgment unit is used for:

[0169] Based on the fourth difference between the third value of the rocket's velocity vector at the end period within the preset sampling period and the fourth value of the first period in the second calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end period within the preset sampling period and the sixth value of the first period, it is judged whether the second calculation result is normal to obtain a fourth judgment result.

[0170] Embodiment 3

[0171] Based on the same inventive concept, an embodiment of the present invention provides a computer device, such as Figure 3 As shown, it includes a memory 304, a processor 302, and a computer program stored in the memory 304 and executable on the processor 302. When the processor 302 executes the program, the steps of the above-mentioned rocket fault-tolerant navigation method are implemented.

[0172] Among them, Figure 3 In the embodiment of the present invention, a bus architecture (represented by bus 300) is shown, which may include any number of interconnected buses and bridges, and bus 300 links various circuits including one or more processors represented by processor 302 and memory represented by memory 304. Bus 300 may also link various other circuits such as peripherals, voltage regulators, and power management circuits, which are well known in the art and are therefore not further described herein. Bus interface 306 provides an interface between bus 300 and receiver 301 and transmitter 303. Receiver 301 and transmitter 303 may be the same element, namely a transceiver, providing a unit for communicating with various other devices over a transmission medium. Processor 302 is responsible for managing bus 300 and general processing, while memory 304 may be used to store data used by processor 302 when performing operations.

[0173] Embodiment 4

[0174] Based on the same inventive concept, an embodiment of the present invention provides a computer-readable storage medium on which a computer program is stored, and when the program is executed by a processor, the steps of the above-mentioned rocket fault-tolerant navigation method are implemented.

[0175] The algorithm and display provided herein are not inherently related to any particular computer, virtual system or other device. Various general purpose systems can also be used together with the teachings based on this. According to the above description, it is obvious that the structure required for constructing such systems. In addition, the present invention is not directed to any specific programming language either. It should be understood that various programming languages ​​can be utilized to realize the content of the present invention described herein, and the description of the above specific languages ​​is for disclosing the best mode of the present invention.

[0176] In the description provided herein, a large number of specific details are described. However, it is understood that embodiments of the present invention can be practiced without these specific details. In some instances, well-known methods, structures and techniques are not shown in detail so as not to obscure the understanding of this description.

[0177] Similarly, it should be understood that in order to streamline the present disclosure and aid in understanding one or more of the various inventive aspects, in the above description of exemplary embodiments of the present invention, various features of the present invention are sometimes grouped together into a single embodiment, figure, or description thereof. However, this disclosed method should not be interpreted as reflecting the intention that the claimed invention requires more features than those explicitly recited in each claim. More specifically, as reflected in the claims below, inventive aspects lie in less than all the features of the individual embodiments disclosed above. Therefore, the claims that follow the specific embodiment are hereby expressly incorporated into the specific embodiment, with each claim itself serving as a separate embodiment of the present invention.

[0178] Those skilled in the art will appreciate that the modules in the devices in the embodiments may be adaptively changed and arranged in one or more devices different from the embodiments. The modules or units or components in the embodiments may be combined into one module or unit or component, and in addition they may be divided into a plurality of submodules or subunits or subcomponents. Except that at least some of such features and / or processes or units are mutually exclusive, all features disclosed in this specification (including the accompanying claims, abstracts and drawings) and all processes or units of any method or device disclosed in this manner may be combined in any combination. Unless otherwise expressly stated, each feature disclosed in this specification (including the accompanying claims, abstracts and drawings) may be replaced by an alternative feature providing the same, equivalent or similar purpose.

[0179] In addition, those skilled in the art will appreciate that, although some embodiments herein include certain features included in other embodiments but not other features, the combination of features of different embodiments is meant to be within the scope of the present invention and form different embodiments. For example, in the claims below, any one of the claimed embodiments may be used in any combination.

[0180] The various component embodiments of the present invention can be implemented in hardware, or in software modules running on one or more processors, or in a combination thereof. It should be understood by those skilled in the art that a microprocessor or digital signal processor (DSP) can be used in practice to implement some or all functions of some or all components in a rocket fault-tolerant navigation device or a computer device according to an embodiment of the present invention. The present invention can also be implemented as a device or device program (e.g., a computer program and a computer program product) for executing part or all of the methods described herein. Such a program implementing the present invention can be stored on a computer-readable medium, or can have the form of one or more signals. Such a signal can be downloaded from an Internet website, or provided on a carrier signal, or provided in any other form.

[0181] It should be noted that the above embodiments illustrate the present invention rather than limit it, and that those skilled in the art may devise alternative embodiments without departing from the scope of the appended claims. In the claims, any reference symbol between brackets shall not be construed as a limitation on the claims. The word "comprising" does not exclude the presence of elements or steps not listed in the claims. The word "one" or "an" preceding an element does not exclude the presence of a plurality of such elements. The present invention may be implemented by means of hardware comprising a number of different elements and by means of a suitably programmed computer. In a unit claim enumerating a number of devices, several of these devices may be embodied by the same hardware item. The use of the words first, second, and third, etc., does not indicate any order. These words may be interpreted as names.

Claims

1. A rocket fault-tolerant navigation method, applied to a rocket navigation system having a master inertial group and a slave inertial group, wherein the slave inertial group adopts a micro-electromechanical system inertial group, and the master inertial group and the slave inertial group both include a gyroscope and an adder table, wherein the gyroscope is used to output angle increment information, and the adder table is used to output velocity increment information. It is characterized in that include: Respectively obtain the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period; Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, determining whether the gyro data of the master inertial group and the gyro data of the slave inertial group within the preset sampling period are consistent, and obtaining a first determination result; Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, determining whether the added table data of the master inertia group and the slave inertia group within the preset sampling period are consistent, and obtaining a second determination result; Navigating the rocket based on the first judgment result and the second judgment result; The step of determining whether the gyro data of the master inertial group and the gyro data of the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period to obtain a first determination result includes: Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, obtaining a first difference between the modulus of the angular increment accumulated value of the master inertial group and the modulus of the angular increment accumulated value of the slave inertial group within the preset sampling period; Determine whether the first difference satisfies an angle increment consistency determination threshold, and obtain a first determination sub-result; Based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, obtaining a first relationship between a vector angle of a cumulative value of the angular increment of the master inertial group and a vector angle of a cumulative value of the angular increment of the slave inertial group within the preset sampling period; Determine whether the first relationship satisfies an angle increment angle threshold or a zero angle increment determination threshold, and obtain a second determination sub-result; Based on the first judgment sub-result and the second judgment sub-result, a first judgment result is obtained.

2. The method according to claim 1, It is characterized in that The step of determining whether the added table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the speed increment information of the master inertial group and the speed increment information of the slave inertial group within the preset sampling period to obtain a second determination result includes: Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, obtaining a second difference between the modulus of the accumulated value of the speed increment of the master inertia group and the modulus of the accumulated value of the speed increment of the slave inertia group within the preset sampling period; Determine whether the second difference satisfies a speed increment consistency determination threshold, and obtain a third determination sub-result; Based on the speed increment information of the master inertia group and the speed increment information of the slave inertia group within the preset sampling period, a second relationship between a vector angle of a speed increment cumulative value of the master inertia group and a vector angle of a speed increment cumulative value of the slave inertia group within the preset sampling period is obtained; Determine whether the second relationship satisfies a speed increment angle threshold or a zero speed increment determination threshold, and obtain a fourth determination sub-result; Based on the third judgment sub-result and the fourth judgment sub-result, a second judgment result is obtained.

3. The method according to claim 1, It is characterized in that The navigating the rocket based on the first judgment result and the second judgment result includes: When both the first judgment result and the second judgment result are yes, obtaining a first calculation result according to the first navigation calculation based on the angular increment information and the velocity increment information of the main inertial group, wherein the first calculation result includes a velocity vector, a position vector, and an attitude vector of the rocket obtained based on the main inertial group; Based on the first calculation result, the rocket is navigated.

4. The method according to claim 3, It is characterized in that Before navigating the rocket based on the first calculation result, the method further includes: The first calculation result is used to correct the second calculation result, wherein the second calculation result is a second calculation result obtained according to a second navigation calculation based on the angular increment information and the velocity increment information from the inertial group, and the second calculation result includes a velocity vector, a position vector and an attitude vector of the rocket obtained from the inertial group.

5. The method according to claim 1, It is characterized in that The navigating the rocket based on the first judgment result and the second judgment result includes: When at least one of the first judgment result and the second judgment result is no, obtaining a first calculation result according to a first navigation calculation based on the angular increment information and the velocity increment information of the master inertial group, and obtaining a second calculation result according to a second navigation calculation based on the angular increment information and the velocity increment information of the slave inertial group; Determine whether the first calculation result is normal, and obtain a third determination result; Determine whether the second calculation result is normal, and obtain a fourth determination result; When the third judgment result is yes, navigating the rocket based on the first calculation result; When the third judgment result is no and the fourth judgment result is yes, navigating the rocket based on the second calculation result; When the third judgment result is no and the fourth judgment result is no, a prompt indicating navigation abnormality is given.

6. The method according to claim 5, It is characterized in that The rocket navigation system further includes: a global satellite positioning system, wherein the determining whether the first calculation result is normal to obtain a third determination result includes: Based on the third difference between the first value of the rocket's velocity vector at the end of the preset sampling period and the second value of the first period in the first calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end of the preset sampling period and the sixth value of the first period, whether the first calculation result is normal is determined to obtain a third judgment result; The determining whether the second calculation result is normal to obtain a fourth determination result includes: Based on the fourth difference between the third value of the rocket's velocity vector at the end period within the preset sampling period and the fourth value of the first period in the second calculation result, and the fifth difference between the fifth value of the global satellite positioning system at the end period within the preset sampling period and the sixth value of the first period, it is judged whether the second calculation result is normal to obtain a fourth judgment result.

7. A rocket fault-tolerant navigation device, the rocket fault-tolerant navigation device is used to implement the method steps as claimed in any one of claims 1 to 6, and is applied to a rocket navigation system having a master inertial group and a slave inertial group, the slave inertial group adopts a micro-electromechanical system inertial group, the master inertial group and the slave inertial group both include a gyroscope and an adder table, the gyroscope is used to output angle increment information, and the adder table is used to output velocity increment information, It is characterized in that include: An acquisition module is used to respectively acquire the angular increment information and the velocity increment information of the master inertia group and the slave inertia group within a preset sampling period; A first judgment module is used to judge whether the gyro data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the angular increment information of the master inertial group and the angular increment information of the slave inertial group within the preset sampling period, so as to obtain a first judgment result; A second judgment module is used to judge whether the added table data of the master inertial group and the slave inertial group within the preset sampling period are consistent based on the speed increment information of the master inertial group and the speed increment information of the slave inertial group within the preset sampling period, so as to obtain a second judgment result; A navigation module is used to navigate the rocket based on the first judgment result and the second judgment result.

8. A computer device comprising a memory, a processor and a computer program stored in the memory and executable on the processor, It is characterized in that When the processor executes the program, the method steps according to any one of claims 1 to 6 are implemented.

9. A computer-readable storage medium having a computer program stored thereon, It is characterized in that When the program is executed by a processor, the method steps as claimed in any one of claims 1 to 6 are implemented.