CN113866688B - Error calibration method for three-axis magnetic sensor under condition of small attitude angle - Google Patents

Error calibration method for three-axis magnetic sensor under condition of small attitude angle Download PDF

Info

Publication number
CN113866688B
CN113866688B CN202111104574.XA CN202111104574A CN113866688B CN 113866688 B CN113866688 B CN 113866688B CN 202111104574 A CN202111104574 A CN 202111104574A CN 113866688 B CN113866688 B CN 113866688B
Authority
CN
China
Prior art keywords
axis
sensor
coordinate system
error
magnetic sensor
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202111104574.XA
Other languages
Chinese (zh)
Other versions
CN113866688A (en
Inventor
刘建国
严有玉
严胜刚
李先刚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN202111104574.XA priority Critical patent/CN113866688B/en
Publication of CN113866688A publication Critical patent/CN113866688A/en
Application granted granted Critical
Publication of CN113866688B publication Critical patent/CN113866688B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01RMEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R33/00Arrangements or instruments for measuring magnetic variables
    • G01R33/02Measuring direction or magnitude of magnetic fields or magnetic flux
    • G01R33/0206Three-component magnetometers
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01RMEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R33/00Arrangements or instruments for measuring magnetic variables
    • G01R33/0023Electronic aspects, e.g. circuits for stimulation, evaluation, control; Treating the measured signals; calibration

Abstract

The invention discloses an error calibration method of a triaxial magnetic sensor under the condition of a small attitude angle, wherein the triaxial magnetic sensor has three errors of triaxial nonorthogonal, inconsistent sensitivity and zero drift due to the imperfect current manufacturing process; the traditional scalar calibration method needs to rotate a sensor along three sensitive axes in a large-range angle, record output values of the sensor under each posture in real time, and then use collected data and an established model to finish calibration. However, when the range of the attitude change of the sensor is limited, it is difficult to achieve a desired calibration effect using the conventional method. The invention establishes an error combined calibration model based on the total geomagnetic level and the vertical component by combining the attitude information of the sensor, adopts an optimization algorithm, and can still accurately solve error parameters when the attitude of the sensor is variable within a small range so as to finish the error calibration of the sensor.

Description

Error calibration method for three-axis magnetic sensor under condition of small attitude angle
Technical Field
The invention belongs to the technical field of sensors, and particularly relates to an error calibration method for a three-axis magnetic sensor.
Background
The currently more common error calibration method for the three-axis magnetic sensor in practice is based on the principle that the modulus of the magnetic field vector at one point in space is not changed, i.e. scalar calibration. This method requires, when executed, a number of extensive changes of the attitude of the sensor (specifically operating with a number of rotations of the sensor along its three sensitive axes) and recording the magnetic field data of the sensor in each attitude. And then, estimating error parameters by using the data and the established error model, and finally compensating the acquired data by using the solved error parameters to finish calibration. However, when the magnetic sensor is installed on a large-scale motion platform such as a ship, an airplane or an aircraft, it is particularly difficult to change the attitude angle of the carrier, particularly the pitch angle and the roll angle, in a large range, and only a small range of change can be performed. This results in a large correlation of the acquired magnetic field data, and if the estimated parameters are trained using these strongly correlated data, the calibration effect will deviate significantly from the ideal. Aiming at the problems existing in the method, the general solution idea is to project the acquired data to a horizontal plane by combining with the attitude information of the magnetic sensor, and then obtain error parameters by utilizing ellipse fitting, wherein the calibration model is called as a two-dimensional total amount model. However, since the measured magnetic field value contains noise and changes with the change of the yaw angle, the combination of the measured magnetic field value and the zero offset cannot be regarded as a constant in the model, and therefore, even if the roll and the yaw angle are fixed by the training sample, the LM or PSO method adopted by the model cannot achieve a good effect for the two-dimensional total quantity model.
Disclosure of Invention
In order to overcome the defects of the prior art, the invention provides an error calibration method of a three-axis magnetic sensor under the condition of a small attitude angle, wherein three errors of three-axis non-orthogonality, inconsistent sensitivity and zero drift exist in the three-axis magnetic sensor due to the imperfect current manufacturing process; the traditional scalar calibration method needs to rotate a sensor along three sensitive axes in a large range of angles, record output values of the sensor under each posture in real time, and then use collected data and an established model to finish calibration. However, when the range of the attitude change of the sensor is limited, it is difficult to achieve a desired calibration effect using the conventional method. The invention establishes an error joint calibration model based on the geomagnetic horizontal total quantity and the vertical component by combining the attitude information of the sensor, and adopts an optimization algorithm, so that when the attitude of the sensor is variable in a small range, error parameters can be accurately solved, and the error calibration of the sensor is completed.
The technical scheme adopted by the invention for solving the technical problem comprises the following steps:
step 1: establishing an error model:
factors influencing the measurement accuracy of the three-axis magnetic sensor comprise three errors of three-axis non-orthogonality, inconsistent scale factors and zero offset;
step 1-1: the non-orthogonal error is expressed in that the actual sensitive axes of the three-axis magnetic sensor are not completely orthogonal in pairs due to the limitation of the manufacturing process;
defining O-XYZ to represent an ideal orthogonal coordinate system; defining O-X ' Y ' Z ' as a coordinate system where three sensitive axes of the actual three-axis magnetic sensor are located, and the coordinate system is called as a sensor coordinate system;
suppose that: (1) The OZ' axis of the sensor coordinate system is coincident with the OZ axis of the ideal orthogonal coordinate system; (2) A Z ' OY ' plane of a sensor coordinate system is coplanar with a ZOY plane of an ideal orthogonal coordinate system, and an included angle between an OY ' axis and an OY axis is alpha; (3) The OX ' axis of the sensor coordinate system deviates downwards from the XOY plane, OX ' is defined as the projection of OX ' on the XOY plane, the included angle between the OX ' axis and the sensor coordinate system is beta, and the included angle between the OX ' axis and the OX axis of the ideal orthogonal coordinate system is gamma;
the relationship between the ideal orthogonal coordinate system and the sensor coordinate system is expressed as:
Figure BDA0003271607320000021
step 1-2: the inconsistent scale factors show that when the three components of the magnetic field are the same, the magnetic field values output by the three shafts of the three-shaft magnetic sensor are different in size and can be represented by a theoretical value multiplied by a diagonal matrix;
step 1-3: the zero offset is represented by that the three axes have zero offset due to the residual magnetism of the magnetic core, the drift of the amplifying and conditioning part of the internal circuit and the external temperature change factors, so that different magnetic fields can be superposed and fixed in the three-axis direction when the three-axis magnetic sensor is used for measurement;
step 1-4: when the three errors are comprehensively considered, the relationship between the actual output value and the theoretical value of the three-axis magnetic sensor is expressed as follows:
B m =RB+b p (2)
wherein, B = [ B = x ,B y ,B z ]For an ideal magnetic field value, B m =[B mx ,B my ,B mz ]Magnetic field values, error matrix for actual three-axis magnetic sensor output
Figure BDA0003271607320000022
k x k y And k z Scale factors representing three axes, respectively, b p =[b x b y b z ] T Zero offset error for a three-axis magnetic sensor;
further derivation yields a true error-free magnetic field representation as:
B=R'(B m -b p ) (3)
wherein R' is the inverse of the error matrix R and is an upper triangular matrix;
and 2, step: establishing a geomagnetic model;
establishing a geographic coordinate system: the coordinate origin is located at the intersection point of a connecting line of a carrier provided with the three-axis magnetic sensor and the earth center and the earth surface, the x axis points to the geographical north, the y axis points to the geographical east, and the z axis points to the earth center vertically; the projections of the earth magnetic field intensity T on the x, y and z axes are respectively north components B N East component B E And a vertical component B D ,B H D and I are respectively a geomagnetic declination and a geomagnetic inclination; t, B N 、B E 、B D 、B H D and I are collectively called as seven elements of the geomagnetic field, and the magnetic field value of any point on the earth surface is described and expressed by seven elements of the geomagnetic field;
the relationship between seven elements of geomagnetism is expressed as:
Figure BDA0003271607320000031
and step 3: establishing an error calibration model of a three-axis magnetic sensor;
when triaxial magnetic sensor error calibration is performed using the geomagnetic field, equation (3) is written as:
Figure BDA0003271607320000032
in the formula (I), the compound is shown in the specification,
Figure BDA0003271607320000033
is the geomagnetic field value in the sensor coordinate system;
the conversion relation between the geographical coordinate system and the sensor coordinate system is described by the connected multiplication of the attitude matrix, so that
Figure BDA0003271607320000034
Expressed as:
Figure BDA0003271607320000035
wherein
Figure BDA0003271607320000036
Gamma, theta and psi are roll, pitch and yaw, respectively; .
Continuing with the derivation formula (6) to obtain:
Figure BDA0003271607320000041
wherein ψ' = ψ -D,
Figure BDA0003271607320000042
k 11 ,k 12 …k 33 the matrix K is an element of the matrix K, and the matrix K can change along with the change of the roll angle and the pitch angle and is not an upper triangular or symmetrical matrix any more;
when the output values of N ≧ 12 groups of sensors under different postures are known, equation (7) is converted into a multi-objective function problem:
Figure BDA0003271607320000043
wherein the variable having the superscript ^' represents the geomagnetic field component represented by the formula (8), B H And B D Respectively representing the horizontal component modulus and the vertical component of the local real geomagnetic field;
and 4, step 4: estimating parameters;
estimating error parameters by adopting an optimization algorithm according to the established error estimation model formula (8);
and 5: and (5) compensating the magnetic field value with the error by using the parameter solved in the step (4) to finish calibration.
Preferably, the horizontal component module and the vertical component of the local real geomagnetic field in the step 3 can be obtained according to a world magnetic field model, and the average value of the measured values is used as a substitute in the experiment.
Preferably, the optimization algorithm in the step 5 is a Levenberg Marquardt algorithm or a particle swarm algorithm.
The invention has the following beneficial effects:
1. under the condition of a small range of attitude angles (the variation range of the pitch angle and the roll angle is less than +/-15 degrees), the method can still accurately estimate error parameters, and is more suitable for error correction of airborne or shipborne triaxial magnetic sensors compared with the existing large-scale calibration method based on the total magnetic field.
2. Compared with a two-dimensional total amount calibration method (magnetic field values are projected to a horizontal plane by using a known attitude angle, and then ellipse fitting is carried out to solve error parameters), the method provided by the invention has a better calibration effect.
Drawings
Fig. 1 is a non-orthogonal error model of a three-axis fluxgate sensor.
FIG. 2 is a diagram of geomagnetic elements in accordance with the present invention.
FIG. 3 is a diagram comparing a conventional method with the method of the present invention.
Detailed Description
The invention is further illustrated with reference to the following figures and examples.
In order to solve the problem that the existing magnetic field total amount calibration method based on the total amount cannot accurately estimate error parameters due to strong correlation among data when the change range of an attitude angle is limited, the invention provides a mixed calibration method based on the horizontal total amount and the vertical component of a magnetic field by combining pitching information and rolling information.
A method for calibrating errors of a three-axis magnetic sensor under the condition of a small attitude angle comprises the following steps:
step 1: establishing an error model:
factors influencing the measurement accuracy of the three-axis magnetic sensor comprise three errors of three-axis non-orthogonality, inconsistent scale factors and zero offset;
step 1-1: the non-orthogonal error is expressed in that the actual sensitive axes of the three-axis magnetic sensor are not completely orthogonal in pairs due to the limitation of the manufacturing process;
FIG. 1 shows a model diagram of non-orthogonal errors of a three-axis fluxgate sensor, defining O-XYZ to represent an ideal orthogonal coordinate system; defining O-X ' Y ' Z ' as a coordinate system of three sensitive axes of the actual three-axis magnetic sensor, and calling the coordinate system as a sensor coordinate system;
suppose that: (1) The OZ' axis of the sensor coordinate system is coincident with the OZ axis of the ideal orthogonal coordinate system; (2) A Z ' OY ' plane of a sensor coordinate system is coplanar with a ZOY plane of an ideal orthogonal coordinate system, and an included angle between an OY ' axis and an OY axis is alpha; (3) The OX ' axis of the sensor coordinate system deviates downwards from the XOY plane, OX ' is defined as the projection of OX ' on the XOY plane, the included angle between the OX ' axis and the sensor coordinate system is beta, and the included angle between the OX ' axis and the OX axis of the ideal orthogonal coordinate system is gamma;
the relationship between the ideal orthogonal coordinate system and the sensor coordinate system is expressed as:
Figure BDA0003271607320000051
step 1-2: the inconsistent scale factors show that when the three components of the magnetic field are the same, the magnetic field values output by the three shafts of the three-shaft magnetic sensor are different in size and can be represented by a theoretical value multiplied by a diagonal matrix;
step 1-3: the zero offset is represented by that the three axes have zero offset due to the residual magnetism of the magnetic core, the drift of the amplifying and conditioning part of the internal circuit and the external temperature change factors, so that different magnetic fields can be superposed and fixed in the three-axis direction when the three-axis magnetic sensor is used for measurement;
step 1-4: when the three errors are comprehensively considered, the relationship between the actual output value and the theoretical value of the three-axis magnetic sensor is expressed as follows:
B m =RB+b p (2)
wherein, B = [ B = x ,B y ,B z ]Ideal magnetic field value, B m =[B mx ,B my ,B mz ]Magnetic field values, error matrix for actual three-axis magnetic sensor output
Figure BDA0003271607320000061
k x k y And k z Scale factors representing three axes, respectively, b p =[b x b y b z ] T Zero offset error of the three-axis magnetic sensor;
further derivation yields a true error-free magnetic field representation as:
B=R'(B m -b p ) (3)
wherein R' is the inverse of the error matrix R and is an upper triangular matrix; 6 elements for solving R' accurately and b p The 3 elements of the vector are the key to the magnetic sensor error calibration problem. The invention establishes a new error solving model, so that the 9 parameters can be accurately estimated even under the condition of a small-range attitude angle.
And 2, step: establishing a geomagnetic model;
the invention utilizes the earth magnetic field to carry out error calibration. As shown in fig. 2, a geographical coordinate system is established: the origin of coordinates is located at the intersection point of a connecting line of the carrier and the earth center and the earth surface, the x axis points to the geographical north, the y axis points to the geographical east, and the z axis points to the earth center vertically; the projections of the earth magnetic field intensity T on the x, y and z axes are north direction components B respectively N East component B E And a vertical component B D ,B H D and I are respectively a geomagnetic declination angle and a geomagnetic inclination angle; t, B N 、B E 、B D 、B H D and I are collectively called as seven elements of the geomagnetic field, and the magnetic field value of any point on the earth surface is described and expressed by seven elements of the geomagnetic field;
the relationship between seven elements of geomagnetism is expressed as:
Figure BDA0003271607320000062
and step 3: establishing an error calibration model of a three-axis magnetic sensor;
when using the geomagnetic field to perform error calibration of the three-axis magnetic sensor, equation (3) is written as:
Figure BDA0003271607320000071
in the formula (I), the compound is shown in the specification,
Figure BDA0003271607320000072
is the geomagnetic field value in the sensor coordinate system;
the transformation relationship between the geographic coordinate system and the sensor coordinate system is described by a connected multiplication of the attitude matrix, so that
Figure BDA0003271607320000073
Expressed as:
Figure BDA0003271607320000074
wherein
Figure BDA0003271607320000075
Gamma, theta and psi are roll, pitch and yaw, respectively; .
Continuing with the derivation formula (6) to obtain:
Figure BDA0003271607320000076
wherein ψ' = ψ -D,
Figure BDA0003271607320000077
k 11 ,k 12 …k 33 the matrix K is an element of the matrix K, and the matrix K can change along with the change of the roll angle and the pitch angle and is not an upper triangular or symmetrical matrix any more;
when the output values of N ≧ 12 groups of sensors under different postures are known, equation (7) is converted into a multi-objective function problem:
Figure BDA0003271607320000078
wherein the variable having the superscript ^' represents the geomagnetic field component represented by the formula (8), B H And B D The horizontal and vertical components, respectively, representing the local true earth magnetic field, can be obtained from the World Magnetic Model (WMM), and the average of the measurements is used as a substitute in the experiment.
And 4, step 4: estimating parameters;
according to the established error estimation model formula (8), a proper optimization algorithm (such as a Levenberg Marquardt algorithm, a particle swarm optimization algorithm and the like) is selected to estimate error parameters (6 elements of R' and b) p 3 elements of the vector).
And 5: and (5) compensating the magnetic field value with the error by using the parameter solved in the step (4) to finish calibration.
The specific embodiment is as follows:
1. example data preparation
The present embodiment considers a scenario in which errors of a three-axis magnetic sensor are calibrated in the context of a geomagnetic field, assuming that the total geomagnetic field is 48000nT, and the geomagnetic declination angle D and the inclination angle I are-5 ° and 5 °, respectively. Error matrix containing quadrature error and scale factor
Figure BDA0003271607320000081
Zero offset is set as b p =[2000 3000 4000] T . According to the settingThe parametric simulation of (1) yields earth magnetic field values for 20 sets of sensors theoretically error-free and actually measured with errors at different attitudes, wherein the pitch and roll angle variation ranges of the sensors are limited to within ± 15 ° to simulate the case of a small range of attitude angles. The structure formula of the earth magnetic field component theoretical value is as follows:
Figure BDA0003271607320000082
the output value of the actual magnetic sensor is constructed by the formula:
Figure BDA0003271607320000085
2. estimating error parameters according to the model provided by the invention;
the generated magnetic field data is brought into the established objective function,
Figure BDA0003271607320000083
the 6 elements of R' and b are estimated by using the Levenberg Marquardt algorithm p 3 elements of the vector. In order to show that the method provided by the invention has better calibration effect than a total amount-based method, the generated magnetic field data is simultaneously brought into a three-dimensional total amount method, and a communicated parameter solving algorithm is adopted to carry out error parameter estimation and comparison. To quantitatively compare the merits of the two methods, the error parameters estimated by the two methods are averaged for absolute deviation (MAD), which is defined as:
Figure BDA0003271607320000084
wherein x is i Represents the set R' and b p Value, c i Representing the values estimated by both models. Table 1 gives the MAD values for both methods.
TABLE 1 comparison of error calibration results for two methods
Figure BDA0003271607320000091
As can be seen from table 1, the MAD of the error parameters obtained by the method proposed by the present invention is small, while the large MAD of the parameters obtained by the total-amount-based calibration method indicates that the estimated parameters deviate significantly from the true values.
3. Test data error calibration
And (3) according to the simulation data set in the step 1, constructing 360 groups of test data under any posture, and correcting the 360 groups of test data by using the error parameters estimated by the two methods in the step 2. The correction formula is as follows: b = R' (B) m -b p ). The data before and after correction are plotted to compare the calibration effect (as shown in fig. 3). As can be seen from the figure, the magnetic field values (indicated by the lines marked with an "x" in the figure) actually output by the magnetic sensor deviate significantly from the true values (indicated by the straight lines in the figure) when the attitude of the sensor changes due to the presence of errors. The fluctuation range of the magnetic field component calibrated by the two methods is reduced, particularly, the magnetic field component (shown by a line with an "o" mark in the figure) calibrated by the method provided by the invention is very close to a theoretical value, and the calibration effect of the traditional method based on the total amount under the condition of a small range of attitude angles is obviously reduced. The result of the embodiment shows that the calibration method provided by the invention still has good error calibration capability under the condition of limited change range of the attitude angle of the sensor.

Claims (3)

1. A method for calibrating errors of a three-axis magnetic sensor under a small attitude angle condition is characterized by comprising the following steps:
step 1: establishing an error model:
factors influencing the measurement accuracy of the three-axis magnetic sensor comprise three errors of three-axis non-orthogonality, inconsistent scale factors and zero offset;
step 1-1: the non-orthogonal error is expressed in that the actual sensitive axes of the three-axis magnetic sensor are not completely orthogonal in pairs due to the limitation of the manufacturing process;
defining O-XYZ to represent an ideal orthogonal coordinate system; defining O-X ' Y ' Z ' as a coordinate system where three sensitive axes of the actual three-axis magnetic sensor are located, and the coordinate system is called as a sensor coordinate system;
suppose that: (1) The OZ' axis of the sensor coordinate system is coincident with the OZ axis of the ideal orthogonal coordinate system; (2) A Z ' OY ' plane of a sensor coordinate system is coplanar with a ZOY plane of an ideal orthogonal coordinate system, and an included angle between an OY ' axis and an OY axis is alpha; (3) The OX ' axis of the sensor coordinate system deviates downwards from an XOY plane, OX is defined as the projection of OX ' on the XOY plane, the included angle between the OX ' axis of the sensor coordinate system and the OX ' axis of the sensor coordinate system is beta, and the included angle between the OX ' axis and the OX axis of an ideal orthogonal coordinate system is gamma;
the relationship between the ideal orthogonal coordinate system and the sensor coordinate system is expressed as:
Figure FDA0003271607310000011
step 1-2: the inconsistent scale factors show that when the three components of the magnetic field are the same, the magnetic field values output by the three shafts of the three-shaft magnetic sensor are different in size and can be represented by a theoretical value multiplied by a diagonal matrix;
step 1-3: the zero offset is represented by that the three axes have zero offset due to the residual magnetism of the magnetic core, the drift of the amplifying and conditioning part of the internal circuit and the external temperature change factors, so that different magnetic fields can be superposed and fixed in the three-axis direction when the three-axis magnetic sensor is used for measurement;
step 1-4: when the three errors are comprehensively considered, the relationship between the actual output value and the theoretical value of the three-axis magnetic sensor is expressed as follows:
B m =RB+b p (2)
wherein, B = [ B = x ,B y ,B z ]Ideal magnetic field value, B m =[B mx ,B my ,B mz ]Magnetic field values, error matrix for actual three-axis magnetic sensor output
Figure FDA0003271607310000021
k x k y And k z Scale factors representing three axes, respectively, b p =[b x b y b z ] T Zero offset error for a three-axis magnetic sensor;
further derivation yields a true error-free magnetic field representation as:
B=R'(B m -b p ) (3)
wherein R' is the inverse of the error matrix R and is an upper triangular matrix;
and 2, step: establishing a geomagnetic model;
establishing a geographic coordinate system: the coordinate origin is located at the intersection point of a connecting line of a carrier provided with the three-axis magnetic sensor and the earth center and the earth surface, the x axis points to the geographical north, the y axis points to the geographical east, and the z axis points to the earth center vertically; the projections of the earth magnetic field intensity T on the x, y and z axes are north direction components B respectively N East component B E And a vertical component B D ,B H D and I are respectively a geomagnetic declination and a geomagnetic inclination; t, B N 、B E 、B D 、B H D and I are collectively called as seven elements of the geomagnetic field, and the magnetic field value of any point on the earth surface is described and expressed by the seven elements of the geomagnetic field;
the relationship between seven elements of geomagnetism is expressed as:
Figure FDA0003271607310000022
and step 3: establishing a three-axis magnetic sensor error calibration model;
when using the geomagnetic field to perform error calibration of the three-axis magnetic sensor, equation (3) is written as:
Figure FDA0003271607310000023
in the formula (I), the compound is shown in the specification,
Figure FDA0003271607310000024
is the geomagnetic field value in the sensor coordinate system;
the conversion relation between the geographic coordinate system and the sensor coordinate system is described by the attitude matrix multiplicationThus, therefore, it is
Figure FDA0003271607310000025
Expressed as:
Figure FDA0003271607310000026
wherein
Figure FDA0003271607310000027
Gamma, theta and psi are roll, pitch and yaw, respectively;
continuing with the derivation formula (6) to obtain:
Figure FDA0003271607310000031
wherein ψ' = ψ -D,
Figure FDA0003271607310000032
k 11 ,k 12 …k 33 the matrix K is an element of the matrix K, and the matrix K can change along with the change of the roll angle and the pitch angle and is not an upper triangular or symmetrical matrix any more;
when the output values of N ≧ 12 groups of sensors under different postures are known, equation (7) is converted into a multi-objective function problem:
Figure FDA0003271607310000033
wherein the variable having the superscript ^' represents the geomagnetic field component represented by formula (8), B H And B D Respectively representing the horizontal component modulus and the vertical component of the local real geomagnetic field;
and 4, step 4: estimating parameters;
estimating error parameters by adopting an optimization algorithm according to the established error estimation model formula (8);
and 5: and (4) compensating the magnetic field value with the error by using the parameter solved in the step (4) to finish calibration.
2. The method for calibrating errors of a three-axis magnetic sensor under the condition of small attitude angle as claimed in claim 1, wherein the horizontal component module and the vertical component of the local real geomagnetic field in the step 3 can be obtained according to a world magnetic field model, and the average value of the measured values is used as a substitute in the experiment.
3. The method for calibrating the error of the three-axis magnetic sensor under the condition of small attitude angle according to claim 1, wherein the optimization algorithm in the step 5 is a Levenberg Marquardt algorithm or a particle swarm algorithm.
CN202111104574.XA 2021-09-22 2021-09-22 Error calibration method for three-axis magnetic sensor under condition of small attitude angle Active CN113866688B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111104574.XA CN113866688B (en) 2021-09-22 2021-09-22 Error calibration method for three-axis magnetic sensor under condition of small attitude angle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111104574.XA CN113866688B (en) 2021-09-22 2021-09-22 Error calibration method for three-axis magnetic sensor under condition of small attitude angle

Publications (2)

Publication Number Publication Date
CN113866688A CN113866688A (en) 2021-12-31
CN113866688B true CN113866688B (en) 2022-10-04

Family

ID=78993045

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111104574.XA Active CN113866688B (en) 2021-09-22 2021-09-22 Error calibration method for three-axis magnetic sensor under condition of small attitude angle

Country Status (1)

Country Link
CN (1) CN113866688B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115507849B (en) * 2022-11-22 2023-03-10 北京理工大学前沿技术研究院 Magnetic sensor correction method and system based on INS/GNSS combined navigation assistance

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4109199A (en) * 1977-10-17 1978-08-22 The United States Of America As Represented By The Secretary Of The Navy Three axis magnetometer calibration checking method and apparatus
JPH11248456A (en) * 1998-02-27 1999-09-17 Olympus Optical Co Ltd Three-axial attitude detecting device
CN103090870A (en) * 2013-01-21 2013-05-08 西北工业大学 Spacecraft attitude measurement method based on MEMS (micro-electromechanical systems) sensor
CN103591949A (en) * 2013-10-25 2014-02-19 西安石油大学 Orthogonal compensation method for triaxial attitude measurement system non-orthogonal error
CN105785477A (en) * 2016-03-09 2016-07-20 中国人民解放军国防科学技术大学 Geomagnetic vector measurement error calibration method with combination of element restriction and summation restriction
CN106125026A (en) * 2016-06-12 2016-11-16 哈尔滨工程大学 A kind of three axis magnetometer total error parameter identification not relying on field, earth's magnetic field amount and bearing calibration
CN106569150A (en) * 2016-11-02 2017-04-19 南京理工大学 Two-step simple correction method for triaxial magnetic sensor
CN106990451A (en) * 2017-02-07 2017-07-28 中国人民解放军国防科学技术大学 Earth magnetism vector measurement system error calibration method based on lagrange's method of multipliers
CN108919156A (en) * 2018-06-27 2018-11-30 中国人民解放军海军航空大学 Bearing calibration under three axis magnetometer line based on noise compensation
CN110174121A (en) * 2019-04-30 2019-08-27 西北工业大学 A kind of aviation attitude system attitude algorithm method based on earth's magnetic field adaptive correction
CN110579730A (en) * 2019-09-02 2019-12-17 杭州电子科技大学 Steering difference correction method of three-axis magnetic sensor
CN110824570A (en) * 2019-10-28 2020-02-21 杭州电子科技大学 Body magnetism correction method of three-axis magnetic sensor
CN111413750A (en) * 2020-04-24 2020-07-14 江苏方天电力技术有限公司 Error correction method of fluxgate sensor for cable positioning
CN112305473A (en) * 2020-10-23 2021-02-02 哈尔滨工程大学 Calibration method of three-axis TMR sensor
CN112731252A (en) * 2021-01-04 2021-04-30 西北工业大学 Error correction method for three-axis magnetic sensor based on partitioned longicorn whisker algorithm
CN112833917A (en) * 2021-01-27 2021-05-25 北京航空航天大学 Three-axis magnetic sensor calibration method based on magnetic course angle and least square method
CN113008227A (en) * 2021-02-05 2021-06-22 中国人民解放军国防科技大学 Geomagnetic binary measurement method based on three-axis accelerometer attitude measurement

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8058866B2 (en) * 2008-09-08 2011-11-15 Infineon Technologies Ag Off-center angle measurement system
US8825426B2 (en) * 2010-04-09 2014-09-02 CSR Technology Holdings Inc. Method and apparatus for calibrating a magnetic sensor
US9279865B2 (en) * 2012-05-09 2016-03-08 Everspin Technologies, Inc. Method and structure for testing and calibrating three axis magnetic field sensing devices
US9207079B2 (en) * 2012-06-21 2015-12-08 Innovative Solutions & Support, Inc. Method and system for compensating for soft iron magnetic disturbances in a heading reference system
WO2014022664A2 (en) * 2012-08-02 2014-02-06 Memsic, Inc. Method and apparatus for data fusion of a three axis magnetometer and three axis accelerometer
WO2014134710A1 (en) * 2013-03-05 2014-09-12 Trusted Positioning Inc. Method and apparatus for fast magnetometer calibration
US9417091B2 (en) * 2013-05-13 2016-08-16 The Johns Hopkins University System and method for determining and correcting field sensors errors
EP3411725B1 (en) * 2016-02-01 2023-02-01 Topcon Positioning Systems, Inc. A method and device for calibration of a three-axis magnetometer
US10288698B2 (en) * 2016-06-13 2019-05-14 Allegro Microsystems, Llc Magnetic field sensor having alignment error correction
FR3069649B1 (en) * 2017-07-26 2021-01-01 Sysnav CALIBRATION PROCESS OF A MAGNETOMETER
FR3069650B1 (en) * 2017-07-26 2020-11-06 Sysnav CALIBRATION PROCESS OF A MAGNETOMETER
US20210095966A1 (en) * 2018-02-28 2021-04-01 Ceva Technologies, Inc. Methods and apparatus for planar magnetometer calibration, heading determination, gyroscope assisted magnetometer amplitude calibration, magnetometer amplitude and alignment calibration, magnetometer mapping, and sensor fusion
US10698066B2 (en) * 2018-04-13 2020-06-30 Texas Instruments Incorporated Calibration of hall device sensitivity using an auxiliary hall device

Patent Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4109199A (en) * 1977-10-17 1978-08-22 The United States Of America As Represented By The Secretary Of The Navy Three axis magnetometer calibration checking method and apparatus
JPH11248456A (en) * 1998-02-27 1999-09-17 Olympus Optical Co Ltd Three-axial attitude detecting device
CN103090870A (en) * 2013-01-21 2013-05-08 西北工业大学 Spacecraft attitude measurement method based on MEMS (micro-electromechanical systems) sensor
CN103591949A (en) * 2013-10-25 2014-02-19 西安石油大学 Orthogonal compensation method for triaxial attitude measurement system non-orthogonal error
CN105785477A (en) * 2016-03-09 2016-07-20 中国人民解放军国防科学技术大学 Geomagnetic vector measurement error calibration method with combination of element restriction and summation restriction
CN106125026A (en) * 2016-06-12 2016-11-16 哈尔滨工程大学 A kind of three axis magnetometer total error parameter identification not relying on field, earth's magnetic field amount and bearing calibration
CN106569150A (en) * 2016-11-02 2017-04-19 南京理工大学 Two-step simple correction method for triaxial magnetic sensor
CN106990451A (en) * 2017-02-07 2017-07-28 中国人民解放军国防科学技术大学 Earth magnetism vector measurement system error calibration method based on lagrange's method of multipliers
CN108919156A (en) * 2018-06-27 2018-11-30 中国人民解放军海军航空大学 Bearing calibration under three axis magnetometer line based on noise compensation
CN110174121A (en) * 2019-04-30 2019-08-27 西北工业大学 A kind of aviation attitude system attitude algorithm method based on earth's magnetic field adaptive correction
CN110579730A (en) * 2019-09-02 2019-12-17 杭州电子科技大学 Steering difference correction method of three-axis magnetic sensor
CN110824570A (en) * 2019-10-28 2020-02-21 杭州电子科技大学 Body magnetism correction method of three-axis magnetic sensor
CN111413750A (en) * 2020-04-24 2020-07-14 江苏方天电力技术有限公司 Error correction method of fluxgate sensor for cable positioning
CN112305473A (en) * 2020-10-23 2021-02-02 哈尔滨工程大学 Calibration method of three-axis TMR sensor
CN112731252A (en) * 2021-01-04 2021-04-30 西北工业大学 Error correction method for three-axis magnetic sensor based on partitioned longicorn whisker algorithm
CN112833917A (en) * 2021-01-27 2021-05-25 北京航空航天大学 Three-axis magnetic sensor calibration method based on magnetic course angle and least square method
CN113008227A (en) * 2021-02-05 2021-06-22 中国人民解放军国防科技大学 Geomagnetic binary measurement method based on three-axis accelerometer attitude measurement

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Detection and localization of underwater targets based on monocular vision;Liu Jianguo 等;《2017 2nd International Conference on Advanced Robotics and Mechatronics (ICARM)》;20180201;全文 *
三分量磁通门梯度仪校准算法研究;杨志成 等;《仪器仪表学报》;20170831;第38卷(第8期);全文 *

Also Published As

Publication number Publication date
CN113866688A (en) 2021-12-31

Similar Documents

Publication Publication Date Title
CN110146839B (en) Correction method for magnetic gradient tensor system of mobile platform
US6543146B2 (en) Electronic compass and compensation of large magnetic errors for operation over all orientations
CN105785477B (en) The earth magnetism vector measurement error calibrating method that a kind of component combines with total amount constraint
CN109556631B (en) INS/GNSS/polarization/geomagnetic combined navigation system alignment method based on least squares
CN104406610B (en) A kind of magnetometer real time correction device and method
CN108333551B (en) Correction method of magnetometer
CN108562305B (en) Five-position quick coarse calibration method for installation error of inertial/astronomical deep integrated navigation system
CN109407159B (en) Geomagnetic full-factor sensor attitude error correction method
CN112461224B (en) Magnetometer calibration method based on known attitude angle
CN104199115B (en) A kind of earth magnetism vector measurement error synthesis compensation method based on linear model
CN103591949A (en) Orthogonal compensation method for triaxial attitude measurement system non-orthogonal error
CN113074752B (en) Dynamic calibration method and system for vehicle-mounted geomagnetic sensor
CN112347625B (en) Magnetic interference compensation method for aircraft carrier
CN112833917B (en) Three-axis magnetic sensor calibration method based on magnetic course angle and least square method
CN113866688B (en) Error calibration method for three-axis magnetic sensor under condition of small attitude angle
CN109000639B (en) Attitude estimation method and device of multiplicative error quaternion geomagnetic tensor field auxiliary gyroscope
CN112461262A (en) Device and method for correcting errors of three-axis magnetometer
CN108871301B (en) Magnetic field azimuth measuring method
CN109931956B (en) Error correction method for mounting three-axis magnetometer and inertial navigation in strapdown three-component magnetic measurement system
CN113567902A (en) Vector magnetic gradiometer steering difference correction method
Chen et al. A novel calibration method for tri-axial magnetometers based on an expanded error model and a two-step total least square algorithm
CN110375773A (en) MEMS inertial navigation system posture initial method
CN111707255A (en) Method for estimating a coordination value of a magnetometer installed in a mobile machine, and related device and computer program
CN110954081A (en) Quick calibration device and method for magnetic compass
CN114325848A (en) Aviation magnetic interference compensation method and device for adaptive correction of compensation coefficient

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant