An adaptive anti-interference navigation enhancement method and system
Patent Information
- Application Number
- CN202410548041.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-05-06
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2044-05-06
Smart Images

Figure CN118444331B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of navigation and positioning technology, and in particular to an adaptive anti-interference navigation enhancement method and system. Background Art
[0002] With the development of science and technology, people's footprints are gradually expanding, and general aviation has become an area that consumers are more and more exposed to. In order to ensure that various aircraft can successfully complete various tasks, a variety of sensors are needed to provide data support, among which the navigation function based on GNSS is particularly important.
[0003] In order to enhance the position accuracy in the process of general navigation, researchers have proposed a high-precision receiving and processing system and method suitable for low-orbit navigation augmentation systems, a navigation augmentation signal generation method and system, and a low-orbit satellite constellation design for regional navigation augmentation. Although they can achieve good navigation augmentation, on the one hand, it is difficult to eliminate the interference generated by the signal during transmission by enhancing the navigation signal from the perspective of low-orbit satellites. On the other hand, only using antennas to receive GNSS signals will bring serious consequences and adverse effects once the GNSS signal deviation is large. Therefore, it is necessary to propose a new type of anti-interference general navigation augmentation method and system. Summary of the invention
[0004] The present invention provides an adaptive anti-interference general navigation enhancement method and system to solve the technical problems of large interference error and single information source in the current general navigation enhancement method.
[0005] In order to solve the above technical problems, the present invention provides the following technical solutions:
[0006] On the one hand, the present invention provides an adaptive anti-interference navigation enhancement method, the adaptive anti-interference navigation enhancement method comprising:
[0007] S1: GNSS position information is collected through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized;
[0008] S2: Calculate the GNSS position difference collected by the main antenna and the auxiliary antenna, and calculate the real interference error;
[0009] S3: Initialize the adaptive interference threshold and update the main antenna position according to the real interference error;
[0010] S4: using the improved Pearson correlation coefficient model to analyze whether the IMU fails, if a failure occurs, directly publish the main antenna position, otherwise execute step S5;
[0011] S5: Use the Kalman filter algorithm to fuse the aircraft position calculated by the IMU and the main antenna position and publish the aircraft position;
[0012] S6: Update the adaptive interference threshold based on the published aircraft position.
[0013] Furthermore, in step S1, GNSS position information is collected by two enhanced antennas mounted on the aircraft, the two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized, including:
[0014] The two enhanced antennas mounted on the aircraft are respectively installed at the head and tail of the aircraft, wherein the enhanced antenna installed at the head is set as the main antenna, and the enhanced antenna installed at the head is set as the auxiliary antenna;
[0015] The GNSS position information collected by the main antenna is p I , the GNSS position information collected by the auxiliary antenna is p s , where p I and p s They are all 1*3 matrices, each containing the position information of the aircraft on the x-axis, y-axis, and z-axis;
[0016] The initial position values of the main antenna and the auxiliary antenna are known, so the GNSS position information collected by the main antenna and the auxiliary antenna is the position information of the second position and thereafter;
[0017] Initialize the position transformation matrix Δα of the two enhanced antennas, where Δα=[0,L,0], and L is the horizontal distance between the two enhanced antennas;
[0018] The IMU collects aircraft acceleration and angular velocity information, integrates the acceleration and angular velocity, and uses them to calculate the aircraft's position.
[0019] Furthermore, the step S2 calculates the GNSS position difference collected by the main antenna and the auxiliary antenna, and calculates the real interference error, including:
[0020] Calculate the GNSS position difference Δp=p collected by the main antenna and the auxiliary antenna I -p s ;
[0021] Calculate the actual interference error Δp′=Δp-Δα.
[0022] Furthermore, in step S3, the adaptive interference threshold is initialized, and the main antenna position is updated according to the real interference error, including:
[0023] When updating the main antenna position, it is necessary to determine whether the actual interference error is abnormal. The specific judgment formula is as follows:
[0024]
[0025] Among them, FLAG indicates the abnormal flag, and others indicates other situations. When the real interference error is greater than 10, it means that the GNSS position information collected by the enhanced antenna is subject to large interference. FLAG is set to 1. At this time, the aircraft position is released by the IMU, and the GNSS receiving frequency is changed, and the new GNSS position information at the next moment is collected again;
[0026] When other situations occur, FLAG is set to 0, indicating that the interference can be reduced at this time, the actual interference error is calculated and the main antenna position is updated.
[0027] Initialize the adaptive interference threshold β, β∈[0,0.25];
[0028] Update the main antenna position p I ′=p I +A + *β*Δp′;
[0029] Among them, A + Is a random number, the value is 1 or -1.
[0030] Furthermore, in step S4, an improved Pearson correlation coefficient model is used to analyze whether the IMU fails. If a failure occurs, the main antenna position is directly released, otherwise step S5 is executed, including:
[0031] The improved Pearson correlation coefficient model is used to analyze whether the IMU fails. The specific formula is as follows:
[0032]
[0033] Among them, p I ′ represents the position of the main antenna at the current moment, p I ′1 represents the position of the main antenna at the previous moment, p IMU represents the aircraft position calculated by the IMU at the current moment, p IMU 1 represents the aircraft position calculated by the IMU at the previous moment;
[0034] When F(p I ′,p I ′1,p IMU , p IMU 1)>1, it indicates that a serious fault has occurred in the IMU. In this case, the main antenna position is directly released. Otherwise, step S5 is executed.
[0035] Furthermore, in step S5, the Kalman filter algorithm is used to fuse the aircraft position and the main antenna position calculated by the IMU and publish the aircraft position, which includes the following steps:
[0036] The position of the main antenna is set as the state quantity, the aircraft position calculated by the IMU is set as the measurement quantity, and the Kalman filter is used to fuse the aircraft position calculated by the IMU and the main antenna position information. The specific update formula is as follows:
[0037] p I-IMU =A*p IMU +B*μ
[0038] p IMU =H*p IMU 1
[0039] Among them, A represents the state transfer matrix, B represents the control input matrix, μ represents the control input, H represents the measurement matrix, and p I-IMU It indicates the published aircraft position after Kalman filter fusion;
[0040] That is, the updated main antenna position and the position information calculated by IMU are fused through Kalman filtering to obtain the published position p I-IMU .
[0041] Furthermore, in step S6, updating the adaptive interference threshold according to the published aircraft position includes:
[0042] Publish the aircraft position p after the Kalman filter algorithm fuses the aircraft and main antenna positions calculated by the IMU I -IMU ;
[0043] The adaptive interference threshold is updated every 60 seconds. The specific formula is as follows:
[0044]
[0045] Wherein, β′ represents the updated adaptive interference threshold.
[0046] On the other hand, the present invention also provides an adaptive anti-interference navigation enhancement system, the adaptive anti-interference navigation enhancement system comprising:
[0047] GNSS information acquisition module: GNSS position information is collected through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized;
[0048] Main antenna position update module: calculates the GNSS position difference collected by the main antenna and the auxiliary antenna, calculates the real interference error, initializes the adaptive interference threshold, and updates the main antenna position;
[0049] Position fusion module: uses the improved Pearson correlation coefficient model to analyze whether the IMU is faulty. If a fault occurs, the main antenna position is directly released. Otherwise, the Kalman filter algorithm is used to fuse the aircraft position calculated by the IMU and the main antenna position and release the aircraft position.
[0050] Adaptive interference threshold update module: updates the adaptive interference threshold based on the published aircraft position.
[0051] The beneficial effects brought about by the technical solution provided by the present invention include at least:
[0052] 1. The navigation enhancement of the present invention is divided into two aspects. First, two enhanced antennas are used to collect GNSS position information. Then, the position of the main antenna and the position calculated by the IMU are fused using Kalman filtering. A double enhancement mechanism is used to enhance the signal and improve the accuracy of the published position.
[0053] 2. Perform anomaly detection on the real interference error before updating the main antenna. Once an anomaly occurs, output the position calculated by IMU at the current moment to avoid serious impact of interference that is difficult to reduce on the position.
[0054] 3. The statistical analysis model is introduced into the navigation enhancement method to realize fault diagnosis, and the improved Pearson correlation coefficient model is used to analyze IMU faults. This method can not only describe the temporary position change rate, but also further determine whether the position change of the main antenna is consistent with the position change of the IMU, thereby avoiding the inaccurate position calculation caused by IMU faults.
[0055] 4. A dual feedback mechanism is used to reduce the impact of interference on the enhanced navigation signal. First, an adaptive threshold is used to act on the actual interference error and update the position of the main antenna. After obtaining more accurate position information, the adaptive threshold is updated again every 60 seconds. This can not only reduce the impact of interference, but also improve computing efficiency and reduce hardware costs. BRIEF DESCRIPTION OF THE DRAWINGS
[0056] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0057] Figure 1 An adaptive anti-interference navigation enhancement method and system step implementation diagram provided by an embodiment of the present invention;
[0058] Figure 2 A schematic diagram of an adaptive anti-interference navigation enhancement method and system modules provided in an embodiment of the present invention. DETAILED DESCRIPTION
[0059] In order to make the objectives, technical solutions and advantages of the present invention more clear, the embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.
[0060] Embodiment 1:
[0061] This embodiment will describe in more detail an adaptive anti-interference navigation enhancement method of the present invention in conjunction with the corresponding drawings. Figure 1 As shown, the method is mainly divided into six steps. The first step is S1: collecting GNSS position information through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized; the second step is S2: calculating the GNSS position difference collected by the main antenna and the auxiliary antenna, and calculating the real interference error; the third step is S3: initializing the adaptive interference threshold, and updating the main antenna position by the real interference error; the fourth step is S4: using the improved Pearson correlation coefficient model to analyze whether the IMU has a fault. If a fault occurs, the main antenna position is directly released, otherwise execute step S5; the fifth step is S5: using the Kalman filter algorithm to fuse the aircraft position and the main antenna position calculated by the IMU and release the aircraft position; the sixth step is S6: updating the adaptive interference threshold by the released aircraft position.
[0062] Specifically, the method of this embodiment includes the following steps:
[0063] Step S1: GNSS position information is collected through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized, including:
[0064] The two enhanced antennas mounted on the aircraft are respectively installed at the head and tail of the aircraft, wherein the enhanced antenna installed at the head is set as the main antenna, and the enhanced antenna installed at the head is set as the auxiliary antenna;
[0065] The GNSS position information collected by the main antenna is p I , the GNSS position information collected by the auxiliary antenna is p s , where p I and p s They are all 1*3 matrices, each containing the position information of the aircraft on the x-axis, y-axis, and z-axis;
[0066] The initial position values of the main antenna and the auxiliary antenna are known, so the GNSS position information collected by the main antenna and the auxiliary antenna is the position information of the second position and thereafter;
[0067] Initialize the position transformation matrix Δα of the two enhanced antennas, where Δα=[0,L,0], and L is the horizontal distance between the two enhanced antennas;
[0068] The IMU collects aircraft acceleration and angular velocity information to calculate the aircraft's position.
[0069] Step S2: Calculate the GNSS position difference collected by the main antenna and the auxiliary antenna, and calculate the real interference error, including:
[0070] Calculate the GNSS position difference Δp=p collected by the main antenna and the auxiliary antenna I -p s ;
[0071] Calculate the actual interference error Δp′=Δp-Δα.
[0072] Step S3: Initialize the adaptive interference threshold and update the main antenna position according to the real interference error, including:
[0073] When updating the main antenna position, it is necessary to determine whether the actual interference error is abnormal. The specific judgment formula is as follows:
[0074]
[0075] Among them, FLAG indicates the abnormal flag, and others indicates other situations. When the real interference error is greater than 10, it means that the GNSS position information collected by the enhanced antenna is subject to large interference. FLAG is set to 1. At this time, the aircraft position is released by the IMU, and the GNSS receiving frequency is changed, and the new GNSS position information at the next moment is collected again;
[0076] When other situations occur, FLAG is set to 0, indicating that the interference can be reduced at this time, the real interference error is calculated and the main antenna position is updated;
[0077] Initialize the adaptive interference threshold β, β∈[0,0.25];
[0078] Update the main antenna position p I ′=p I +A + *β*Δp′;
[0079] Among them, A + Is a random number, the value is 1 or -1.
[0080] Step S4: the improved Pearson correlation coefficient model is used to analyze whether the IMU fails. If a failure occurs, the main antenna position is directly released. Otherwise, step S5 is executed, including:
[0081] The improved Pearson correlation coefficient model is used to analyze whether the IMU is faulty. The specific formula is as follows:
[0082]
[0083] Among them, p I ′ represents the position of the main antenna at the current moment, p I ′1 represents the position of the main antenna at the previous moment, p IMU represents the aircraft position calculated by the IMU at the current moment, p IMU 1 represents the aircraft position calculated by the IMU at the previous moment;
[0084] When F(p I ′,p I ′1,p IMU , p IMU 1)>1, it indicates that a serious fault has occurred in the IMU. In this case, the main antenna position is directly released. Otherwise, step S5 is executed.
[0085] Step S5: Use the Kalman filter algorithm to fuse the aircraft position and the main antenna position calculated by the IMU and publish the aircraft position.
[0086] The position of the main antenna is set as the state quantity, the aircraft position calculated by the IMU is set as the measurement quantity, and the Kalman filter is used to fuse the aircraft position calculated by the IMU and the main antenna position information. The specific update formula is as follows:
[0087] p I-IMU =A*p IMU +B*μ
[0088] p IMU =H*p IMU 1
[0089] Among them, A represents the state transfer matrix, B represents the control input matrix, μ represents the control input, H represents the measurement matrix, and p I-IMU It indicates the published aircraft position after Kalman filter fusion;
[0090] That is, the published position p is obtained by fusing the updated main antenna position and the aircraft position information calculated by the IMU through Kalman filtering. I-IMU .
[0091] Step S6: Updating the adaptive interference threshold based on the published aircraft position, including:
[0092] Publish the aircraft position p after the Kalman filter algorithm fuses the aircraft and main antenna positions calculated by the IMU I -IMU ;
[0093] The adaptive interference threshold is updated every 60 seconds. The specific formula is as follows:
[0094]
[0095] Wherein, β′ represents the updated adaptive interference threshold.
[0096] Embodiment 2:
[0097] This embodiment provides an adaptive anti-interference navigation augmentation system. The main modules of the adaptive anti-interference navigation augmentation system are as follows: Figure 2 As shown:
[0098] GNSS information acquisition module: GNSS position information is collected through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized;
[0099] Main antenna position update module: calculates the GNSS position difference collected by the main antenna and the auxiliary antenna, calculates the real interference error, initializes the adaptive interference threshold, and updates the main antenna position;
[0100] Position fusion module: uses the improved Pearson correlation coefficient model to analyze whether the IMU is faulty. If a fault occurs, the main antenna position is directly released. Otherwise, the Kalman filter algorithm is used to fuse the aircraft position calculated by the IMU and the main antenna position and release the aircraft position.
[0101] Adaptive interference threshold update module: updates the adaptive interference threshold based on the published aircraft position.
[0102] The adaptive anti-interference general aviation navigation enhancement system of the present embodiment corresponds to the adaptive anti-interference general aviation navigation enhancement method of the above-mentioned embodiment; wherein, the functions implemented by each functional module in the adaptive anti-interference general aviation navigation enhancement system of the present embodiment correspond one-to-one to each process step in the adaptive anti-interference general aviation navigation enhancement method of the above-mentioned embodiment; therefore, they will not be repeated here.
Claims
1. An adaptive anti-interference navigation enhancement method, characterized in that: The following steps are involved: S1: GNSS position information is collected through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized; S2: Calculate the GNSS position difference collected by the main antenna and the auxiliary antenna, and calculate the real interference error; S3: Initialize the adaptive interference threshold and update the main antenna position according to the real interference error; S4: using the improved Pearson correlation coefficient model to analyze whether the IMU fails, if a failure occurs, directly publish the main antenna position, otherwise execute step S5; S5: Use the Kalman filter algorithm to fuse the aircraft position calculated by the IMU and the main antenna position and publish the aircraft position; S6: Update the adaptive interference threshold based on the published aircraft position.
2. The adaptive anti-interference navigation enhancement method according to claim 1, characterized in that: In step S1, GNSS position information is collected by two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized, including the following steps: The two enhanced antennas mounted on the aircraft are respectively installed at the head and tail of the aircraft, wherein the enhanced antenna installed at the head is set as the main antenna, and the enhanced antenna installed at the head is set as the auxiliary antenna; The GNSS position information collected by the main antenna is , the GNSS position information collected by the auxiliary antenna is ,in, and They are all 1*3 matrices, each containing the position information of the aircraft on the x-axis, y-axis, and z-axis; The initial position values of the main antenna and the auxiliary antenna are known, and the GNSS position information collected by the main antenna and the auxiliary antenna is the second position and thereafter; Initialize the position transformation matrix of the two enhanced antennas ,in , L is the horizontal distance between the two enhanced antennas; The IMU collects aircraft acceleration and angular velocity information to calculate the aircraft's position.
3. The adaptive anti-interference navigation enhancement method according to claim 2, characterized in that: The step S2 calculates the GNSS position difference collected by the main antenna and the auxiliary antenna, and calculates the real interference error, including the following steps: Calculate the GNSS position difference between the main antenna and the auxiliary antenna ; Calculate the true interference error .
4. The adaptive anti-interference navigation enhancement method according to claim 3, characterized in that: Initializing the adaptive interference threshold in step S3 and updating the main antenna position according to the real interference error includes the following steps: Initialize adaptive interference threshold , ; Update main antenna position ; in, Is a random number, the value is 1 or -1.
5. The adaptive anti-interference navigation enhancement method according to claim 4, characterized in that: In step S5, the Kalman filter algorithm is used to fuse the aircraft position and the main antenna position calculated by the IMU and publish the aircraft position, which includes the following steps: The position of the main antenna is set as the state quantity, the aircraft position calculated by the IMU is set as the measurement quantity, and the Kalman filter is used to fuse the aircraft position calculated by the IMU and the main antenna position information. The specific update formula is as follows: ; ; in, represents the state transfer matrix, B represents the control input matrix, represents the control input, represents the measurement matrix, It indicates the published aircraft position after Kalman filter fusion; Indicates the aircraft position calculated by the IMU at the current moment, Indicates the aircraft position calculated by the IMU at the previous moment.
6. An adaptive anti-interference navigation enhancement system, characterized in that: Includes the following modules: GNSS information acquisition module: GNSS position information is collected through two enhanced antennas mounted on the aircraft, and the IMU calculates the aircraft position. The two enhanced antennas are divided into a main antenna and an auxiliary antenna, and the position transformation matrix of the two enhanced antennas is initialized; Main antenna position update module: calculates the GNSS position difference collected by the main antenna and the auxiliary antenna, calculates the real interference error, initializes the adaptive interference threshold, and updates the main antenna position; Position fusion module: uses the improved Pearson correlation coefficient model to analyze whether the IMU is faulty. If a fault occurs, the main antenna position is directly released. Otherwise, the Kalman filter algorithm is used to fuse the aircraft position calculated by the IMU and the main antenna position and release the aircraft position. Adaptive interference threshold update module: updates the adaptive interference threshold according to the published aircraft position; Implement an adaptive anti-interference navigation enhancement method as described in any one of claims 1-5.
