Joint estimation method for installation error angle and background geomagnetic vector of vector magnetic measurement system

CN123028628APending Publication Date: 2026-11-03崂山国家实验室
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611047093.2
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-07-14
Publication Date
2026-11-03

AI Technical Summary

Technical Problem

In existing vector magnetic measurement systems, the installation error angle between the inertial navigation coordinate system and the three-component magnetometer coordinate system is difficult to correct accurately, resulting in a decrease in the accuracy of geomagnetic vector information measurement. Especially when the background geomagnetic vector is unknown, existing methods are unable to effectively estimate the installation error angle.

Method used

A genetic algorithm combined with a non-magnetic turntable rotation is used to randomly rotate the vector magnetic measurement system in a calm background magnetic field region. Data is collected synchronously using a three-component magnetometer and an inertial navigation system. A joint estimation method for minimizing the installation error angle and the background geomagnetic vector is established. The objective function is constructed and iteratively solved using the geomagnetic vector in the inertial navigation coordinate system converted from the background geomagnetic vector in the geographic coordinate system as the reference.

Benefits of technology

It achieves efficient joint estimation of installation error angle and background geomagnetic vector, simplifies the calibration process, improves the accuracy of geomagnetic vector measurement, and is suitable for practical engineering applications.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123028628A_ABST
    Figure CN123028628A_ABST
Patent Text Reader

Abstract

The present application relates to a kind of installation error angle and background geomagnetic vector joint estimation method of vector magnetic measurement system, belong to geomagnetic survey technical field.The joint estimation method includes the following steps: in the area where background magnetic field is calm, using non-magnetic turntable rotation vector magnetic measurement system, during rotation, synchronous acquisition geomagnetic three components, roll angle, pitch angle and heading angle;With the background geomagnetic vector of geographic coordinate system conversion to the geomagnetic vector of inertial navigation coordinate system as reference, the root mean square error of each component of the geomagnetic vector after the acquisition geomagnetic three components conversion to inertial navigation coordinate system is obtained, with the root mean square error of each component of geomagnetic vector minimization as constraint, the objective function for solving installation error angle and background geomagnetic vector and the minimization problem to be solved are established;Iterative solution is carried out using genetic algorithm, and the optimal estimation value of installation error angle and background geomagnetic vector is obtained.The joint estimation method can realize the joint estimation of installation error angle and background geomagnetic vector, and is suitable for practical engineering application.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention belongs to the field of geomagnetic measurement technology, and particularly relates to a method for jointly estimating the installation error angle and background geomagnetic vector of a vector magnetic measurement system. Background Technology

[0002] Vector magnetometry systems are used for geomagnetic vector field measurements, acquiring information about the components of the geomagnetic field and thus obtaining the seven geomagnetic elements. Compared to traditional scalar field measurements, the geomagnetic vector field measured by vector magnetometry systems yields richer geomagnetic information. For example... Figure 1 As shown, the vector magnetic measurement system mainly consists of an inertial navigation system (INS) 3 (i.e., a high-precision inertial navigation system), a three-component magnetometer 1, a data acquisition computer, a data logger, a GNSS antenna, and a non-magnetic rigid structure 2. The INS 3 and the three-component magnetometer 1 are strapped together via the non-magnetic rigid structure 2 to ensure accurate attitude transmission between them. During the measurement process, the INS 3 is used to measure the inertial coordinate system. ( The direction is to the right. The direction is forward. (Direction is upward) relative to the geographic coordinate system ( The direction is east. The direction is north. The attitude and heading angle data (direction: azimuth) are obtained, and the three-component magnetometer 1 is used to measure the coordinate system of the three-component magnetometer. ( The direction is to the right. The direction is forward. The three components of geomagnetism (with the direction being upward) are rotated to the geographic coordinate system based on the attitude and heading angle measured by the inertial navigation system 3, and the geomagnetic vector field information under the geographic coordinate system is obtained. This enables the measurement of geomagnetic vector field under the dynamic conditions of a mobile carrier.

[0003] However, as Figure 2 As shown, in practical applications, the inertial navigation coordinate system With the coordinate system of the three-component magnetometer Since they are all invisible, it is difficult to guarantee the inertial navigation coordinate system simply by relying on structural installation. With the coordinate system of the three-component magnetometer Perfect alignment, meaning the unavoidable installation error angle (also known as misalignment error angle) between the inertial navigation system 3 and the three-component magnetometer 1, introduces errors during the rotation of the geomagnetic three-component coordinates, thus severely affecting the measurement accuracy of geomagnetic vector information. Simulation experiments show that under a background geomagnetic magnetic field of 50,000 nT, a coordinate system misalignment error angle of 0.1 degrees can cause an error on the order of 100 nT in the geomagnetic vector field. Therefore, in practical applications, it is crucial to effectively estimate the installation error angle and effectively correct for installation errors.

[0004] Regarding the correction of installation error angles, some research has been conducted. For example, Luo Jiangang et al. proposed a method for correcting misalignment errors based on a genetic algorithm (see "Luo Jiangang, Zhang Feng, Liu Jingxiao, et al. Misalignment error correction of vector magnetic measurement based on genetic algorithm [J]. Journal of Detection and Control, 2021, 43 (04): 51-57"). This method uses the background geomagnetic vector as prior information, rotates the background geomagnetic vector to the inertial navigation coordinate system according to the inertial navigation attitude angle, randomly generates a small-angle rotation matrix from the three-component magnetometer to the inertial navigation coordinate system, rotates the three-component magnetic field of the magnetometer, calculates the root mean square error between the rotated three components and the three components in the inertial navigation coordinate system, and uses the genetic algorithm to obtain the optimal rotation matrix from the three-component magnetometer to the inertial navigation coordinate system with the minimization of the root mean square error as a constraint. However, this method requires the background geomagnetic vector as prior information, which is generally unknown, increasing the difficulty of using this method. Summary of the Invention

[0005] To address the aforementioned shortcomings of existing methods for correcting the installation error angle of a three-component magnetometer and inertial navigation system in vector magnetic measurement systems, this invention provides a joint estimation method for the installation error angle and background geomagnetic vector of a vector magnetic measurement system. This method enables the joint estimation of the installation error angle and background geomagnetic vector, making it suitable for practical engineering applications.

[0006] This invention provides a method for jointly estimating the installation error angle and background geomagnetic vector of a vector magnetic measurement system, comprising the following steps: S1. In a region with a calm background magnetic field, a non-magnetic turntable is used to rotate the vector magnetic measurement system. During the rotation, a three-component magnetometer is used to collect the three components of the geomagnetic field, and an inertial navigation system is used to simultaneously collect the roll angle, pitch angle, and heading angle. S2. Based on the data collected in step S1, transform the background geomagnetic vector in the geographic coordinate system to the geomagnetic vector in the inertial navigation coordinate system. Using this as a reference, calculate the geomagnetic vector after transforming the three components of the geomagnetism acquired by the three-component magnetometer into the inertial navigation coordinate system. The root mean square error of each component, in terms of geomagnetic vector Minimizing the root mean square error of each component is the constraint, with the geomagnetic vector as the basis. The sum of the root mean square errors of each component, divided by the total number of components, is used as the objective function to solve for the installation error angle and the background geomagnetic vector, thus establishing the minimization problem to be solved. S3. For the minimization problem established in step S2, the genetic algorithm is used to iteratively solve the problem and obtain the optimal estimates of the installation error angle and the background geomagnetic vector.

[0007] In some embodiments, in step S2, the established objective function is: Solve ; in, Let be the vector of installation error angle parameters to be solved. , , and These are the rotation angles of the three-component magnetometer coordinate system relative to the inertial navigation coordinate system in the Y, X, and Z directions, respectively, expressed in angle form; , and These are geomagnetic vectors. Root mean square error of components in the X, Y, and Z directions , and The calculation formulas are as follows: ; in, , and They will be the first t The three components of the geomagnetic field collected in the second sampling Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, , t =1, 2, ..., n , n This refers to the number of data collections. , and Based on the first t The data acquired by the secondary inertial navigation system will include the background geomagnetic vector in the geographic coordinate system. Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, ; Among them, geomagnetic vector and geomagnetic vector The calculation formulas are as follows:

[0008]

[0009] in, This is the rotation matrix for transforming the three-component magnetometer coordinate system to the inertial navigation coordinate system. for The transpose of the matrix, For the first t The rotation matrix for transforming the inertial navigation coordinate system to the geographic coordinate system corresponding to the next acquisition. and The calculation formulas are as follows:

[0010]

[0011] in, For the first t The roll angle of the next acquisition; For the first t The elevation angle of the next acquisition; For the first t The heading angle collected in this instance.

[0012] In some embodiments, the specific steps of using a genetic algorithm for iterative solution in step S3 are as follows: S31, According to the formula , will the t The three components of the geomagnetic field collected in the second sampling Directly convert to the geographic coordinate system to obtain the geomagnetic vector that ignores the installation error angle. ,Will The X, Y, and Z components are denoted as follows: , and ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as Let the background geomagnetic vector ; S32, the installation error angular parameter vector to be solved As chromosomes, the number of chromosome genes is set. D And the range of gene values, and set the population size. NP Maximum number of iterations G Crossover probability P c and mutation probabilityP m ; S33, Take k =1, randomly generated based on the gene value range. NP Each chromosome constitutes the first generation of the population. Q ,in, ; S34, Calculating Population Q The fitness value of each chromosome is used to determine the optimal chromosome. ; Among them, population Q The Middle i Fitness value of each chromosome The calculation formula is as follows: ; in, By the first i Chromosomes and current background geomagnetic vector Substitute into the objective function Calculations show that i =1, 2, ..., NP ; S35, Based on Optimal Chromosomes According to the formula , will the t The three components of the geomagnetic field collected in the second sampling First, convert to the inertial coordinate system, then convert to the geographic coordinate system to obtain the corrected geomagnetic vector. ,Will The X, Y, and Z components are denoted as follows: , and ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as Let the background geomagnetic vector To update the background geomagnetic vector ; S36, Select the optimal chromosome Assigned to the population Q Odd-numbered chromosomes, based on crossover probability P cCrossover operations are performed on odd-numbered and even-numbered chromosomes, based on the mutation probability. P m Mutation operations are performed on genes on each chromosome to generate subpopulations. Q s , sub-population Q s and its corresponding parent population Q Merging results in a merged population. Q n ; S37, Calculate merged populations Q n The fitness values ​​of all chromosomes in the population were used to select the merged populations in descending order of fitness value. Q n The chromosomes in the sample are reordered, and the merged population is selected. Q n The former NP Each chromosome makes up the next generation population. Q ; Among them, merging populations Q n The Middle j Fitness value of each chromosome The calculation formula is as follows: ; in, By the first j Chromosomes and current background geomagnetic vector Substitute into the objective function Calculations show that j =1, 2, ..., 2 NP ; S38, Seeking Population Q The chromosome with the highest fitness value is selected as the optimal chromosome. ,Pick ; S39, if Then the iteration ends and the optimal chromosome is output. As the optimal estimate of the installation error angle, the current background geomagnetic vector is output. Use this as the optimal estimate of the background geomagnetic vector; otherwise, repeat steps S35~S39.

[0013] In some embodiments, in step S31, the installation error angle parameter vector to be solved is... The vector dimension is used to set the number of chromosome genes. D =3, setting the gene value range to 3. Set population size NP =100, setting the maximum number of iterations.G =300, set the crossover probability. P c =0.6, setting the mutation probability. P m =0.4.

[0014] Compared with the prior art, the advantages and beneficial effects of the present invention are as follows: 1. The method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided by this invention transforms the background geomagnetic vector in the geographic coordinate system to the geomagnetic vector in the inertial navigation coordinate system. Using this as a reference, calculate the geomagnetic vector after transforming the three components of the geomagnetism acquired by the three-component magnetometer into the inertial navigation coordinate system. The root mean square error of each component, in terms of geomagnetic vector Minimizing the root mean square error of each component is taken as a constraint, thus transforming the estimation problem of the installation error angle and the background geomagnetic vector into a minimization problem. The joint estimation of the installation error angle and the background geomagnetic vector is realized by using a genetic algorithm. 2. The method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided by the present invention only requires the vector magnetic measurement system to rotate freely in a region with a calm background magnetic field when collecting calibration data. It does not require rotation around a fixed axis or fixed plane. There are no special requirements for the calibration process. The calibration method is simple, highly operable, and suitable for practical engineering applications. 3. The method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided by this invention uses a genetic algorithm for solving. During iterative calculation, the optimal estimated value of the installation error angle obtained each time is used to correct the installation error of the system. The average value of each component of the corrected geomagnetic vector is used as the background geomagnetic vector in the next iteration calculation, thereby gradually obtaining the optimal estimated values ​​of the installation error angle and background geomagnetic vector through iteration. This iterative method has strong global search capability, is stable and efficient, and is conducive to improving the estimation efficiency of the installation error angle and background geomagnetic vector. Attached Figure Description

[0015] Figure 1 This is a schematic diagram of the coordinate system involved in the operation of a vector magnetic measurement system in the prior art; Figure 2 This is a schematic diagram illustrating the correction process for the installation error angle of the three-component magnetometer and inertial navigation system. Figure 3 This is a flowchart of the method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided in the embodiments of the present invention; Figure 4 The flowchart illustrates the iterative solution using a genetic algorithm in the joint estimation method of the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided in this embodiment of the invention. Figure 5This is a graph of the three-component geomagnetic curves obtained by the three-component magnetometer in Embodiment 1 of the present invention. Figure 6 This is a graph showing the roll angle, pitch angle, and yaw angle curves obtained by inertial navigation in Embodiment 1 of the present invention. Figure 7 This is a comparison diagram of the set value of the installation error angle and the estimated value during the iterative solution process in Embodiment 1 of the present invention, wherein (a) corresponds to (b) corresponds (c) corresponds to ; Figure 8 This is a comparison diagram of the set value and the estimated value of the background geomagnetic vector in Embodiment 1 of the present invention, wherein (a) corresponds to (b) corresponds (c) corresponds to .

[0016] In the picture: 1. Three-component magnetometer; 2. Non-magnetic rigid structural component; 3. Inertial navigation system. Detailed Implementation

[0017] The technical solutions in the embodiments of the present invention will be clearly and completely described below. Obviously, the described embodiments are only some embodiments of the present invention, and not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.

[0018] like Figure 1 As shown, the operation of the vector magnetic measurement system involves three coordinate systems, namely the three-component magnetometer coordinate system. ( The direction is to the right. The direction is forward. (Direction is upward) Inertial navigation coordinate system ( The direction is to the right. The direction is forward. (Direction is upward) and local geographic coordinate system ( The direction is east. The direction is north. The direction is upward (towards the sky).

[0019] During the operation of the vector magnetic measurement system, inertial navigation system 3 measures the inertial navigation coordinate system. Relative to geographic coordinate system Roll angle r Pitch angle p and heading angle hThree-component magnetometer 1 measures the coordinate system of the three-component magnetometer. The three components of the Earth's magnetic field Ideally, the three-component magnetometer coordinate system and inertial navigation coordinate system In the alignment state, the measurement results of inertial navigation system 3 (i.e. r , p and h ), the three components of the geomagnetic field at the same time Accurate conversion to geographic coordinate system Below, obtain the geomagnetic vector in the geographic coordinate system. The conversion process is represented as follows: Equation (1); In equation (1), This is the rotation matrix for transforming the inertial coordinate system to the geographic coordinate system. The expression is as follows: Equation (2).

[0020] like Figure 2 As shown, in practical engineering, relying solely on structural installation methods is insufficient to guarantee the stability of the inertial navigation coordinate system. and the coordinate system of the three-component magnetometer The corresponding coordinate axes are strictly parallel; in fact, the inertial navigation coordinate system... and the coordinate system of the three-component magnetometer There is a certain angle between the corresponding coordinate axes, which is the installation error angle. The existence of the installation error angle affects the calculated geomagnetic vector. There is an error.

[0021] Due to the inertial coordinate system and the coordinate system of the three-component magnetometer Both are orthogonal coordinate systems. According to the theory of inertia, three basic rotations can be used to make the corresponding axes of the two orthogonal coordinate systems parallel, eliminating the angular deviations of the corresponding axes of the coordinate systems, thus achieving the correction of installation errors. The rotation process can be represented as: Equation (3); In equation (3), Inertial navigation coordinate system , Representing the coordinate system of a three-component magnetometer , This is the rotation matrix for transforming the three-component magnetometer coordinate system to the inertial navigation coordinate system.

[0022] In equation (3), The expression is as follows: Equation (4); In equation (4), , and These represent the rotation angles of the three-component magnetometer coordinate system relative to the inertial navigation coordinate system in the Y, X, and Z directions, respectively.

[0023] The installation error angular parameter vector to be solved The installation error angle correction process is as follows: Figure 2 As shown, the rotation sequence during correction is as follows: .

[0024] Based on the above process, if we can obtain... Then, the three components of the geomagnetic field can be divided first. The geomagnetic vector is obtained by rotating to the inertial coordinate system. ,remember Then, based on the roll angle collected by inertial navigation system 3... r Pitch angle p and heading angle h ,Will Rotate to the geographic coordinate system to obtain the corrected geomagnetic vector. ,remember This achieves installation error correction, and the correction process described above can be represented as follows: Equation (5) Equation (6).

[0025] Substituting equation (5) into equation (6), we obtain the following calculation formula: Equation (7).

[0026] Let the background geomagnetic vector in the geographic coordinate system be... Based on the roll angle collected by inertial navigation system 3 r Pitch angle p and heading angle h The background geomagnetic vector can also be used. The geomagnetic vector is obtained by rotating to the inertial coordinate system. ,remember The conversion process is represented as follows: Equation (8); In equation (8), for The transpose of .

[0027] When the vector magnetic measurement system rotates arbitrarily in space, it can acquire a set of corresponding geomagnetic three components. Roll angle Pitch angle Heading angle ,in, t =1, 2, ..., n , n This refers to the number of data collections. Therefore, based on the collected data, the background geomagnetic vector in the geographic coordinate system is used. Geomagnetic vector transformed to inertial coordinate system Based on this, the three components of the geomagnetic field can be obtained. Geomagnetic vector transformed to inertial coordinate system The root mean square error of each component, in terms of geomagnetic vector Minimizing the root mean square error of each component is the constraint. Based on equations (5) and (8), a method can be constructed to obtain the root mean square error of each component. Objective function of the optimal estimate The minimization problem to be solved is established as follows: make Equation (9), The objective function is defined as follows: Equation (10); Therefore, to solve The problem of finding the optimal estimate is transformed into solving a minimization problem. ; In equations (9) and (10), , and These are geomagnetic vectors. The root mean square error of the components in the X, Y, and Z directions; , and According to equation (5), the first t The three components of the geomagnetic field collected in the second sampling Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, ; , and Based on the first t The data collected by the secondary inertial navigation system, according to equation (8), will be used to determine the background geomagnetic vector. Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, .

[0028] In reality, the background geomagnetic vector It is also an unknown quantity.

[0029] Based on the above derivation process, such as Figure 3As shown, this embodiment of the invention provides a method for jointly estimating the installation error angle and background geomagnetic vector of a vector magnetic measurement system, including the following steps: S1. In a region with a calm background magnetic field, a vector magnetic measurement system is rotated using a non-magnetic turntable. During rotation, the three-component magnetometer 1 collects the three components of the geomagnetic field, and the inertial navigation system 3 simultaneously collects the roll angle, pitch angle, and yaw angle; among which, the first... t The three components of the geomagnetic field collected in this study are denoted as... , No. t The roll angle of the next acquisition is denoted as , No. t The elevation angle of the second acquisition is recorded as... , No. t The heading angle collected in this instance is denoted as , t =1, 2, ..., n , n This represents the number of data collections.

[0030] S2. Based on the data collected in step S1, transform the background geomagnetic vector in the geographic coordinate system to the geomagnetic vector in the inertial navigation coordinate system. Using this as a reference, calculate the geomagnetic vector after transforming the three components of the geomagnetism acquired by the three-component magnetometer into the inertial navigation coordinate system. The root mean square error of each component, in terms of geomagnetic vector Minimizing the root mean square error of each component is the constraint, with the geomagnetic vector as the basis. The sum of the root mean square errors of each component, divided by the total number of components, is used as the objective function to solve for the installation error angle and the background geomagnetic vector, thus establishing the minimization problem to be solved.

[0031] In this step, the expression for the objective function is as follows: , i.e., equation (10); in, Let be the vector of installation error angle parameters to be solved. , , and These are the rotation angles of the three-component magnetometer coordinate system relative to the inertial navigation coordinate system in the Y, X, and Z directions, respectively, expressed in angle form; , and These are geomagnetic vectors. The root mean square error of the components in the X, Y, and Z directions.

[0032] With geomagnetic vector Minimizing the root mean square error of each component is the constraint, and the solution will be... The problem of finding the optimal estimate is transformed into solving a minimization problem. .

[0033] In equation (10), , and The calculation formulas are as follows: That is, equation (9); In equation (9), , and They will be the first t The three components of the geomagnetic field collected in the second sampling Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, ; , and Based on the first t The data acquired by the secondary inertial navigation system will include the background geomagnetic vector. Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, .

[0034] Among them, geomagnetic vector and geomagnetic vector The calculation formulas are as follows: That is, equation (5); That is, equation (8); In equations (5) and (8), This is the rotation matrix for transforming the three-component magnetometer coordinate system to the inertial navigation coordinate system. for The transpose of the matrix, For the first t The rotation matrix for transforming the inertial navigation coordinate system to the geographic coordinate system corresponding to each acquisition.

[0035] in, and The calculation formulas are as follows: , i.e., equation (4); That is, equation (2).

[0036] S3. For the minimization problem established in step S2, the genetic algorithm is used to iteratively solve the problem and obtain the optimal estimates of the installation error angle and the background geomagnetic vector.

[0037] like Figure 4 As shown, the specific steps of iteratively solving using a genetic algorithm in this step are as follows: S31. Set the initial value of the background geomagnetic vector. According to equation (1) , will the t The three components of the geomagnetic field collected in the second sampling Directly convert to the geographic coordinate system to obtain the geomagnetic vector that ignores the installation error angle. ,Will The X, Y, and Z components are denoted as follows: , and ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as Let the background geomagnetic vector .

[0038] S32. Set the parameters of the genetic algorithm. The installation error angular parameter vector to be solved As chromosomes, the number of chromosome genes is set. D And the range of gene values, and set the population size. NP Maximum number of iterations G Crossover probability P c and mutation probability P m .

[0039] Specifically, based on the installation error angle parameter vector to be solved... The vector dimension is used to set the number of chromosome genes. D =3, setting the gene value range to 3. Set population size NP =100, setting the maximum number of iterations. G =300, set the crossover probability. P c =0.6, setting the mutation probability. P m =0.4.

[0040] S33. Initialize the population Pick k =1, randomly generated based on the gene value range. NP Each chromosome constitutes the first generation of the population. Q ,in, .

[0041] S34. Calculate the fitness value of each chromosome in the initial population and obtain the optimal chromosome. Calculate population Q The fitness value of each chromosome is used to determine the optimal chromosome. ; Among them, population Q The Middle i Fitness value of each chromosome The calculation formula is as follows: Equation (11); In equation (11), By the first i Chromosomes and current background geomagnetic vector Substitute into the objective function Calculations show that i =1, 2, ..., NP .

[0042] S35, Update background geomagnetic vector based on optimal chromosome Based on optimal chromosome According to equation (7) , will the t The three components of the geomagnetic field collected in the second sampling First, convert to the inertial coordinate system, then convert to the geographic coordinate system to obtain the corrected geomagnetic vector. ,Will The X, Y, and Z components are denoted as follows: , and ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as Let the background geomagnetic vector To update the background geomagnetic vector .

[0043] S36. Crossover and mutation operations and population merging Optimal chromosome Assigned to the population Q Odd-numbered chromosomes, based on crossover probability Pc Crossover operations are performed on odd-numbered and even-numbered chromosomes, based on the mutation probability. P m Mutation operations are performed on genes on each chromosome to generate subpopulations. Q s , sub-population Q s and its corresponding parent population Q Merging results in a merged population. Q n .

[0044] S37. Calculate the fitness value of each chromosome in the merged population and construct the next generation population. Calculate merged populations Q n The fitness values ​​of all chromosomes in the population were used to select the merged populations in descending order of fitness value. Q n The chromosomes in the sample are reordered, and the merged population is selected. Q n The former NP Each chromosome makes up the next generation population. Q ; Among them, merging populations Q n The Middle j Fitness value of each chromosome The calculation formula is as follows: Equation (12); In equation (12), By the first j Chromosomes and current background geomagnetic vector Substitute into the objective function Calculations show that j =1, 2, ..., 2 NP .

[0045] S38. Update the optimal chromosome. Take population Q The chromosome with the highest fitness value is selected as the optimal chromosome. ,Pick .

[0046] S39. Termination Condition Judgment like Then the iteration ends and the optimal chromosome is output. As the optimal estimate of the installation error angle, the current background geomagnetic vector is output. Use this as the optimal estimate of the background geomagnetic vector; otherwise, repeat steps S35~S39.

[0047] The above-mentioned method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system transforms the background geomagnetic vector in the geographic coordinate system to the geomagnetic vector in the inertial navigation coordinate system. Using this as a reference, calculate the geomagnetic vector after transforming the three components of the geomagnetism acquired by the three-component magnetometer into the inertial navigation coordinate system. The root mean square error of each component, in terms of geomagnetic vector Minimizing the root mean square error of each component is used as a constraint, thus transforming the estimation problem of the installation error angle and the background geomagnetic vector into a minimization problem. A genetic algorithm is then used to achieve the joint estimation of the installation error angle and the background geomagnetic vector. Furthermore, this method for jointly estimating the installation error angle and the background geomagnetic vector of the vector magnetic measurement system only requires the system to rotate freely in a region with a calm background magnetic field during calibration data acquisition, without needing to rotate around a fixed axis or plane. The calibration process has no special requirements, is simple, highly operable, and suitable for practical engineering applications. In addition, this method utilizes a genetic algorithm for solving the problem. During iterative calculations, the optimal estimate of the installation error angle obtained each time is used to correct the system's installation error. The average value of each component of the corrected geomagnetic vector is then used as the background geomagnetic vector in the next iteration, thus iteratively obtaining the optimal estimates of the installation error angle and the background geomagnetic vector. This iterative method has strong global search capabilities, is stable and efficient, and is beneficial for improving the estimation efficiency of the installation error angle and the background geomagnetic vector.

[0048] To more clearly and in detail introduce the method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided in the embodiments of the present invention, the following description will be based on specific embodiments.

[0049] Example 1 An experiment was conducted using the joint estimation method for the installation error angle and background geomagnetic vector of the vector magnetic measurement system provided by this invention. During the experiment, the installation error angles of the three-component magnetometer and inertial navigation system in the Y, X, and Z directions were set as follows: =-0.3°、 =0.5° =0.2°; Set the background geomagnetic field F =52200 nT, magnetic inclination angle I =54.3°, magnetic declination d =-7.6°, the background geomagnetic vector in the geographic coordinate system is calculated. The calculation formula is as follows: Equation (13).

[0050] (1) According to step S1 of the present invention, under the set magnetic field environment, the vector magnetic measurement system with the set installation error angle is rotated using a non-magnetic turntable to simulate the rotation state of the real vector magnetic measurement system under the carrier condition. 500 sets of calibration data are collected simultaneously using a three-component magnetometer and an inertial navigation system. When collecting data, Gaussian white noise with a mean of 0 and a standard deviation of 0.5nT is added to the geomagnetic three-component data collected by the three-component magnetometer, and Gaussian white noise with a mean of 0 and a standard deviation of 0.00001° is added to the data collected by the inertial navigation system. The geomagnetic three-component data collected by the three-component magnetometer are... Data such as Figure 5 As shown, the roll angle obtained by the inertial navigation system Pitch angle and heading angle Data such as Figure 6 As shown.

[0051] (2) Establish the objective function and the minimization problem to be solved according to step S2 of the present invention.

[0052] (3) According to step S3 of the present invention, a genetic algorithm is used for iterative solution. During iterative calculation, the number of chromosome genes is set. D =3, setting the gene value range to 3. Set population size NP =100, setting the maximum number of iterations. G =300, set the crossover probability. P c =0.6, setting the mutation probability. P m =0.4.

[0053] Figure 7 This shows the current estimate of the installation error angle obtained in each iteration (i.e., the current optimal chromosome). A comparison chart of the installation error angle with the set value during the test. Figure 8 A comparison chart is shown between the current estimated value of the background geomagnetic vector obtained from each iteration and the set value of the background geomagnetic vector during the experiment. After 300 iterations, the optimal estimated values ​​of the installation error angle and the background geomagnetic vector are shown in Table 1. As can be seen from Table 1, the joint estimation method of the installation error angle and the background geomagnetic vector for the vector magnetic measurement system provided by this invention has high estimation accuracy for both the installation error angle and the background geomagnetic vector, and can effectively correct the installation error angle, thereby improving the accuracy of geomagnetic vector field measurement.

[0054] Table 1 Comparison of Optimal Estimated Values ​​and Set Values ​​for Installation Error Angle and Background Geomagnetic Vector

Claims

1. A method for jointly estimating the installation error angle and background geomagnetic vector of a vector magnetic measurement system, characterized in that, Includes the following steps: S1. In a region with a calm background magnetic field, a non-magnetic turntable is used to rotate the vector magnetic measurement system. During the rotation, a three-component magnetometer is used to collect the three components of the geomagnetic field, and an inertial navigation system is used to simultaneously collect the roll angle, pitch angle, and heading angle. S2. Based on the data collected in step S1, transform the background geomagnetic vector in the geographic coordinate system to the geomagnetic vector in the inertial navigation coordinate system. Using this as a reference, calculate the geomagnetic vector after transforming the three components of the geomagnetism acquired by the three-component magnetometer into the inertial navigation coordinate system. The root mean square error of each component, in terms of geomagnetic vector Minimizing the root mean square error of each component is the constraint, with the geomagnetic vector as the basis. The sum of the root mean square errors of each component, divided by the total number of components, is used as the objective function to solve for the installation error angle and the background geomagnetic vector, thus establishing the minimization problem to be solved. S3. For the minimization problem established in step S2, the genetic algorithm is used to iteratively solve the problem and obtain the optimal estimates of the installation error angle and the background geomagnetic vector.

2. The method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system according to claim 1, characterized in that, In step S2, the objective function is established as follows: Solve ; in, Let be the vector of installation error angle parameters to be solved. , , and These are the rotation angles of the three-component magnetometer coordinate system relative to the inertial navigation coordinate system in the Y, X, and Z directions, respectively, expressed in angle form; , and These are geomagnetic vectors. Root mean square error of components in the X, Y, and Z directions , and The calculation formulas are as follows: ; in, , and They will be the first t The three components of the geomagnetic field collected in the second sampling Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, , t =1, 2, ..., n , n This represents the number of data collections. , and Based on the first t The data acquired by the secondary inertial navigation system will include the background geomagnetic vector in the geographic coordinate system. Geomagnetic vector obtained by transformation to inertial coordinate system The X, Y, and Z components, ; Among them, geomagnetic vector and geomagnetic vector The calculation formulas are as follows: in, This is the rotation matrix for transforming the three-component magnetometer coordinate system to the inertial navigation coordinate system. for The transpose of the matrix, For the first t The rotation matrix for transforming the inertial navigation coordinate system to the geographic coordinate system corresponding to the next acquisition. and The calculation formulas are as follows: in, For the first t The roll angle of the next acquisition; For the first t The elevation angle of the next acquisition; For the first t The heading angle collected in this instance.

3. The method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system according to claim 2, characterized in that, In step S3, the specific steps of iteratively solving using a genetic algorithm are as follows: S31, According to the formula , will the t The three components of the geomagnetic field collected in the second sampling Directly convert to the geographic coordinate system to obtain the geomagnetic vector that ignores installation error angles. ,Will The X, Y, and Z components are denoted as follows: , and ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as Let the background geomagnetic vector ; S32, the installation error angular parameter vector to be solved As chromosomes, the number of chromosome genes is set. D And the range of gene values, and set the population size. NP Maximum number of iterations G Crossover probability P c and mutation probability P m ; S33, Take k =1, randomly generated based on the gene value range. NP Each chromosome constitutes the first generation of the population. Q ,in, ; S34, Calculating Population Q The fitness value of each chromosome is used to determine the optimal chromosome. ; Among them, population Q The Middle i Fitness value of each chromosome The calculation formula is as follows: ; in, By the first i Chromosomes and current background geomagnetic vector Substitute into the objective function Calculations show that i =1, 2, ..., NP ; S35, Based on Optimal Chromosomes According to the formula , will the t The three components of the geomagnetic field collected in the second sampling First, convert to the inertial coordinate system, then convert to the geographic coordinate system to obtain the corrected geomagnetic vector. ,Will The X, Y, and Z components are denoted as follows: , and ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as ,Will , ... The average value is denoted as Let the background geomagnetic vector To update the background geomagnetic vector ; S36, Select the optimal chromosome Assigned to the population Q Odd-numbered chromosomes, based on crossover probability P c Crossover operations are performed on odd-numbered and even-numbered chromosomes, based on the mutation probability. P m Mutation operations are performed on genes on each chromosome to generate subpopulations. Q s , sub-population Q s and its corresponding parent population Q Merging results in a merged population. Q n ; S37, Calculate merged populations Q n The fitness values ​​of all chromosomes in the population were used to select the merged populations in descending order of fitness values. Q n The chromosomes in the sample are reordered, and the merged population is selected. Q n The former NP Each chromosome makes up the next generation population. Q ; Among them, merging populations Q n The Middle j Fitness value of each chromosome The calculation formula is as follows: ; in, By the first j Chromosomes and current background geomagnetic vector Substitute into the objective function Calculations show that j =1, 2, ..., 2 NP ; S38, Seeking Population Q The chromosome with the highest fitness value is selected as the optimal chromosome. ,Pick ; S39, if Then the iteration ends and the optimal chromosome is output. As the optimal estimate of the installation error angle, the current background geomagnetic vector is output. Use this as the optimal estimate of the background geomagnetic vector; otherwise, repeat steps S35~S39.

4. The method for jointly estimating the installation error angle and background geomagnetic vector of the vector magnetic measurement system according to claim 3, characterized in that, In step S31, the installation error angle parameter vector to be solved is... The vector dimension is used to set the number of chromosome genes. D =3, setting the gene value range to 3. Set population size NP =100, setting the maximum number of iterations. G =300, set the crossover probability. P c =0.6, setting the mutation probability. P m =0.4.