CN108507553A - The bearing calibration of electronic compass - Google Patents
The bearing calibration of electronic compass Download PDFInfo
- Publication number
- CN108507553A CN108507553A CN201810385964.0A CN201810385964A CN108507553A CN 108507553 A CN108507553 A CN 108507553A CN 201810385964 A CN201810385964 A CN 201810385964A CN 108507553 A CN108507553 A CN 108507553A
- Authority
- CN
- China
- Prior art keywords
- data
- coordinate system
- error
- electronic compass
- error parameter
- 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.)
- Pending
Links
- 230000005291 magnetic effect Effects 0.000 claims abstract description 74
- 238000000034 method Methods 0.000 claims abstract description 20
- 230000005389 magnetism Effects 0.000 claims abstract description 11
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims abstract description 6
- 238000004891 communication Methods 0.000 claims description 23
- 238000012937 correction Methods 0.000 claims description 18
- 230000035945 sensitivity Effects 0.000 claims description 9
- 238000013519 translation Methods 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 7
- 239000011159 matrix material Substances 0.000 claims description 7
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 claims description 4
- 229910052782 aluminium Inorganic materials 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000007789 sealing Methods 0.000 claims description 4
- 239000004411 aluminium Substances 0.000 claims description 3
- 230000003750 conditioning effect Effects 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims 1
- 238000009434 installation Methods 0.000 description 13
- 238000004422 calculation algorithm Methods 0.000 description 5
- 230000007613 environmental effect Effects 0.000 description 3
- 239000000463 material Substances 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 239000003302 ferromagnetic material Substances 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 239000000696 magnetic material Substances 0.000 description 1
- 230000005415 magnetization Effects 0.000 description 1
- 210000003739 neck Anatomy 0.000 description 1
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
- 238000010998 test method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/02—Magnetic compasses
- G01C17/28—Electromagnetic compasses
- G01C17/32—Electron compasses
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
- G01C17/38—Testing, calibrating, or compensating of compasses
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
The invention discloses a kind of bearing calibrations of electronic compass, include the following steps:(1)Pedestal error parameter is obtained, obtains the magnetic field data of Earth and inclination data of current environment respectively by Magnetic Sensor and obliquity sensor, is sent into microprocessor;(2)Pour angle compensation is carried out to magnetic field data;(3)According to step(2)The data of acquisition carry out azimuth solution;(4)Hard Magnetic mushing error parameter, the soft magnetism mushing error parameter for obtaining erecting bed constitute error parameter with pedestal error parameter;(5)Using error parameter to step(3)Data carry out error compensation, obtain attitude angle data;(6)In conjunction with posture position compensation method, actual coordinates coordinate origin is moved into measuring coordinate system origin.The present invention solves the problems, such as that conditional electronic compass only has and provides posture position information output function, using the posture information that itself is provided, while not changing original hardware system structure, and research posture position compensation.
Description
Technical field
The present invention relates to a kind of test method of compass more particularly to a kind of bearing calibrations of electronic compass.
Background technology
Electronic compass as a kind of earth-magnetism navigation module, be it is a kind of using earth magnetic field and acceleration of gravity come measurement direction
Important navigational tool, output azimuth, attitude angle, the measured values such as magnetic field value can provide course and posture information, have in real time
Small, simple in structure, small power consumption, it is at low cost the advantages that, be widely used in the necks such as aviation, navigation, vehicle positioning, geological prospecting
Domain.
Conditional electronic compass hardware system includes mainly Magnetic Sensor, obliquity sensor, signal conditioning circuit, A/D conversions
Circuit, microprocessor, power circuit, serial communication circuit, software systems include mainly that data acquire, and azimuth solves, error
Parameter calculates, error compensation.Software section major function includes:Magnetic Sensor is completed in control and the data of obliquity sensor are adopted
Collection compensates correction to collected data and azimuth resolves, last serial ports output azimuth, attitude angle information.
Traditional electronic compass technology problem and defect are mainly reflected in following two aspects:
The first, only have the processing to earth magnetic field and acceleration of gravity signal, display, storage or transmission function, do not have
The standby error correction function to external signal.
The second, do not have and work(is corrected by communication interface realization again to the error compensation parameter that microprocessor internal is embedded in
Can, it is installed on that machine system alignment is relatively complicated, is not suitable in the machine system of long-term unattended and inconvenient movement.
Moreover, electronic compass using be it is general can all pass through the internal mode automatically corrected and obtain correction parameter, with into
Row error compensation, method is substantially:It needs that product attitude angle is kept to be less than 15 ° of slowly rotations, slewing area is come more than 360 °
Realize product correction.
If the installation environment of product is in removable, rotatable state, inside can be carried out at this time and is automatically corrected.If product
Mounted on when the positions such as can not rotate, rotate, then it can not complete to correct, electronic compass must be disassembled herein, it is non-
It is often inconvenient.It is individually good using rotation mode correction to the electronic compass even if disassembling product, it can not compensate in this way
Carrier platform, which exists, interferes soft magnetism interference and Hard Magnetic caused by electronic compass.
Invention content
The purpose of the present invention be that provide one kind solve the above problems, be suitable for variety carrier, and not by installation site,
Mounting means limits, and can complete the bearing calibration of the electronic compass of correction.
To achieve the goals above, the technical solution adopted by the present invention is such:A kind of bearing calibration of electronic compass,
Including electronic compass, the electronic compass includes body, cover board and the circuit unit in body, and the circuit unit includes
Data acquisition circuit, microprocessor, serial communication circuit and power circuit, the data acquisition circuit include magnetic sensor
And obliquity sensor, the magnetic sensor are used to obtain the three axis earth's magnetic field value of the earth of current environment, and through signal condition
It is sent into microprocessor after circuit, A/D conversion circuits, the terrestrial gravitation that the obliquity sensor is used to obtain current environment accelerates
Angle value, and it is converted into inclination value, it is sent into microprocessor, the serial ports of the microprocessor is connect with serial communication circuit, the string
For port communications circuit for being communicated with host computer, the shell side is equipped with communication interface plug-in unit, and the communication interface plug-in unit is used for
Connect serial communication circuit and power circuit;
The bearing calibration of the electronic compass includes the following steps:
(1) system initialization, obtain the error of zero parameter of electronic compass, sensitivity error parameter, quadrature error parameter,
Installation error parameter, temperature error parameter, prestore into microprocessor as basic error parameter, pass through Magnetic Sensor and inclination angle
Sensor obtains the magnetic field data of Earth and inclination data of current environment respectively, is sent into microprocessor;
(2) microprocessor carries out pour angle compensation using inclination data to magnetic field data, then by inclination data and compensation
Magnetic field data afterwards carries out data prediction;
(3) azimuth solution is carried out according to the data that step (2) obtains;Export the azimuth compensated without correction parameter
Data;
(4) Hard Magnetic mushing error parameter, the soft magnetism mushing error parameter for obtaining erecting bed, are constituted with pedestal error parameter
Error parameter;
(5) error parameter is utilized, error compensation is carried out to the data of step (3), obtains attitude angle data;
(6) attitude angle data obtained according to step (5), in conjunction with posture position compensation method, by actual coordinates coordinate
Origin translation is to measuring coordinate system origin.
As preferred:The specific method of step (2) pour angle compensation is:
(21) magnetic field strength component X, Y, Z of tri- axis of carrier coordinate system X, Y, Z are measured using magnetic sensor;
(22) gravitational acceleration component Ax, Ay, Az that tri- axis of carrier X, Y, Z are measured by obliquity sensor, in conjunction with sky
Between geometry calculate roll angle θ and pitch angle δ, formula it is as follows:
(23) slope compensation
By the roll angle and pitch angle measured, in conjunction with magnetic field strength component X, Y, the Z measured, according to vector triangle,
The horizontal magnetic intensity X being transformed under terrestrial coordinate systemHAnd YH;
XH=Xcos (δ)+Ysin (θ) sin (δ)-Zcos (θ) sin (δ) (3)
YH=Ycos (θ)+Zsin (θ) (4)
As preferred:The specific method of azimuth solution is in the step (3):
The X that formula (3) and (4) are found outHAnd YH, bring following formula into and find out azimuth angle alpha:
As preferred:In the step (6), it is specially in conjunction with posture position compensation method:
Coordinate system (x after translation2,y2,z2) with the relationship of measuring coordinate system (x, y, z) be:
1) the rotation alpha angles counterclockwise about the z axis coordinate system XYZ, are transformed to coordinate system X1Y1Z;
2) coordinate system X1Y1Z is around Y1Axis is counterclockwise rotation β angle, is transformed to coordinate system X2Y1Z1;
3) coordinate system X2Y1Z1Around X2Axis rotates the angles γ counterclockwise, is transformed to coordinate system X2Y2Z2;
Rotation angle α, β, γ in above-mentioned rotary course are known as " Euler's rotation angle ", are provided by electronic compass, measuring coordinate
It is that (x, y, z) passes through the coordinate system (x three times after reference axis rotation transformation to translation2,y2,z2) in, above-mentioned rotary course square
The form that battle array is multiplied is expressed as
It enables
Coordinate in measuring coordinate system is
As preferred:The body, which is adopted, to be formed from aluminium, and sealing ring is equipped between cover board and body.
Compared with the prior art, the advantages of the present invention are as follows:The present invention solves conditional electronic compass and only has offer appearance
State location information output function problem, using the posture information that itself is provided, while not changing original hardware system structure,
Study posture position compensation method and environmental disturbances field compensation method.
In addition, manufacturing body using aluminum material, it is avoided that body interferes earth's magnetic field, it is waterproof using sealing ring.
Description of the drawings
Fig. 1 is schematic structural view of the invention;
Fig. 2 is circuit diagram of the present invention;
Fig. 3 is the flow chart of the embodiment of the present invention 1;
Fig. 4 is measuring coordinate system and actual coordinates relational graph in embodiment 1;
Fig. 5 is coordinate system and measuring coordinate system relationship after being translated in embodiment 1;
Fig. 6 is the front and back simulation comparison figure of step (6) compensation;
Fig. 7 is the flow chart of the embodiment of the present invention 3.
In figure:1, cover board;2, circuit unit;3, body;4, communication interface plug-in unit.
Specific implementation mode
The present invention will be further described with reference to the accompanying drawings.
Embodiment 1:Referring to Fig. 1 to Fig. 6, a kind of bearing calibration of electronic compass, including electronic compass, the electronic compass
Including body, cover board and the circuit unit in body, the circuit unit includes data acquisition circuit, microprocessor, string
Port communications circuit and power circuit, the data acquisition circuit include magnetic sensor and obliquity sensor, the three axis magnetic
Sensor is used to obtain the three axis earth's magnetic field value of the earth of current environment, and is sent into after signal conditioning circuit, A/D conversion circuits micro-
In processor, the obliquity sensor is used to obtain the terrestrial gravitation acceleration value of current environment, and is converted into inclination value, is sent into
The serial ports of microprocessor, the microprocessor is connect with serial communication circuit, and the serial communication circuit is used for logical with host computer
Letter, the shell side are equipped with communication interface plug-in unit, and the communication interface plug-in unit is for connecting serial communication circuit and power supply electricity
Road;The body, which is adopted, to be formed from aluminium, and sealing ring is equipped between cover board and body.
The bearing calibration of the electronic compass includes the following steps:
(1) system initialization, obtain the error of zero parameter of electronic compass, sensitivity error parameter, quadrature error parameter,
Installation error parameter, temperature error parameter, prestore into microprocessor as basic error parameter, pass through Magnetic Sensor and inclination angle
Sensor obtains the magnetic field data of Earth and inclination data of current environment respectively, is sent into microprocessor;
(2) microprocessor carries out pour angle compensation using inclination data to magnetic field data, then by inclination data and compensation
Magnetic field data afterwards carries out data prediction;
(3) azimuth solution is carried out according to the data that step (2) obtains;Export the azimuth compensated without correction parameter
Data;
(4) Hard Magnetic mushing error parameter, the soft magnetism mushing error parameter for obtaining erecting bed, are constituted with pedestal error parameter
Error parameter;
(5) error parameter is utilized, error compensation is carried out to the data of step (3), obtains attitude angle data;
(6) attitude angle data obtained according to step (5), in conjunction with posture position compensation method, by actual coordinates coordinate
Origin translation is to measuring coordinate system origin.
In the present embodiment:The specific method of step (2) pour angle compensation is:
(21) magnetic field strength component X, Y, Z of tri- axis of carrier coordinate system X, Y, Z are measured using magnetic sensor;
(22) gravitational acceleration component Ax, Ay, Az that tri- axis of carrier X, Y, Z are measured by obliquity sensor, in conjunction with sky
Between geometry calculate roll angle θ and pitch angle δ, formula it is as follows:
(23) slope compensation
By the roll angle and pitch angle measured, in conjunction with magnetic field strength component X, Y, the Z measured, according to vector triangle,
The horizontal magnetic intensity X being transformed under terrestrial coordinate systemHAnd YH;
XH=Xcos (δ)+Ysin (θ) sin (δ)-Zcos (θ) sin (δ) (3)
YH=Ycos (θ)+Zsin (θ) (4)
The specific method of azimuth solution is in the step (3):
The X that formula (3) and (4) are found outHAnd YH, bring following formula into and find out azimuth angle alpha:
In the step (6), it is specially in conjunction with posture position compensation method:
Coordinate system (x after translation2,y2,z2) with the relationship of measuring coordinate system (x, y, z) be:
1) the rotation alpha angles counterclockwise about the z axis coordinate system XYZ, are transformed to coordinate system X1Y1Z;
2) coordinate system X1Y1Z is around Y1Axis is counterclockwise rotation β angle, is transformed to coordinate system X2Y1Z1;
3) coordinate system X2Y1Z1Around X2Axis rotates the angles γ counterclockwise, is transformed to coordinate system X2Y2Z2;
Rotation angle α, β, γ in above-mentioned rotary course are known as " Euler's rotation angle ", are provided by electronic compass, measuring coordinate
It is that (x, y, z) passes through the coordinate system (x three times after reference axis rotation transformation to translation2,y2,z2) in, above-mentioned rotary course square
The form that battle array is multiplied is expressed as
It enables
Coordinate in measuring coordinate system is
So far the compensation of node posture position is completed.
α=2 °, β=2 °, when γ=1 °, it is assumed that electronic compass measures position and misses
Poor maximum value is ± 0.01m, when attitude error maximum value is ± 0.1 °, is compensated using the above method and does not have balanced emulation to tie
Fruit is as shown in Figure 6, wherein the lines of that intermediate fluctuation very little are the emulation datagram before compensation, and it is to mend to fluctuate big lines
Emulation datagram after repaying, it can be seen that by that can greatly improve data precision after compensation, root-mean-square error is by 0.7335 drop
It is 0.0235, has dropped an order of magnitude.
Wherein, Hard Magnetic mushing error parameter, the soft magnetism mushing error parameter for obtaining erecting bed are constituted with pedestal error and are missed
Poor parameter;It is the communication interface plug-in unit by shell side, is input in microprocessor through serial communication circuit.
Embodiment 2:In the prior art, electronic compass all carries internal autonomy correction mode and instructs.Azimuth solve with
Before, first increase a part and judge, host computer inputs the instruction of " whether needing to correct ", after microprocessor receives, if being not necessarily to school
Just, attitude angle information directly is solved using the error parameter combination azimuth solution to prestore, if desired corrected, then enter inside
In autonomous calibration mode instruction:
It needs that product attitude angle is kept to be less than 15 ° of slowly rotations, slewing area realizes that product is corrected more than 360 °;Herein
Period executes acquisition sensing data program by the correction program of embedded microprocessor internal, and gathered data includes mainly
Magnetic field data in " after data prediction " link and inclination data are calculated when the points of acquisition are enough by embedded correction
Method processing and correction parameter solution procedure, error parameter is solved and is stored;It is further continued for operation azimuth to solve, error
Compensation software program finally exports new azimuth, attitude angle data;Then host computer stores output of products data, finally sends out
It send and stops autonomous mode correction instruction.
Herein, in internal autonomy correction mode, error parameter includes error of zero parameter, sensitivity error parameter, orthogonal
Error parameter, installation error parameter, Hard Magnetic mushing error parameter, soft magnetism mushing error parameter, temperature error etc..
(1) error of zero:Error of zero parameter is inputted, error of zero program is run, passes through error of zero parameter and magnetic field
Measured value, inclination angle measured value carry out the algorithm matrix operation, and the factors such as the null offset of Magnetic Sensor and obliquity sensor are caused
Azimuth angle error compensate, complete offset output value complement repay;
(2) sensitivity error:According to azimuth solution formula, when X-axis and the product of Y-axis sensitivity and amplification factor differ
When cause, azimuth angle error, therefore input sensitivity error parameter will be caused, adjust the correspondence scale factor of X, Y, Z axis magnetic field value
(sensitivity error parameter) runs sensitivity error program, itself and measured magnetic field, inclination angle measured value are carried out algorithm operation,
Realize compensation function;
(3) quadrature error:Because of the manufacture of Magnetic Sensor, installation error, error magnetic field caused by causing X, Y, Z axis non-orthogonal
Measurement error, final calculate cause azimuth angle error, input quadrature error parameter, run quadrature error compensation program, by X,
Y, the error compensation that is orthogonal has been calculated by program with measured magnetic field, inclination angle measured value in the angle change data of Z axis;
(4) installation error:When Magnetic Sensor and obliquity sensor are because of installation each axis and carrier reference axis it is not parallel due to lead
The installation error of cause inputs installation error parameter, runs installation error program, by installation error parameter and measured magnetic field, inclines
Angle measurement carries out the algorithm matrix operation, completes compensation function;
(5) Hard Magnetic mushing error:Fixed magnetic field interferes caused by the magnetic field synthesis of a variety of ferromagnetic materials around system
Caused measured magnetic field error inputs Hard Magnetic mushing error coefficient, Hard Magnetic mushing error program is run, by Hard Magnetic mushing error
It influences magnitude and measured magnetic field carries out the algorithm matrix operation, complete compensation function;
(6) soft magnetism mushing error:The magnetic field caused by the interference of variation magnetic field caused by soft magnetic materials magnetization phenomenon around is surveyed
Magnitude error, the interference is mainly related with environmental magnetic field and material itself, therefore inputs soft magnetism mushing error coefficient, runs soft magnetism
Mushing error model calculation program, by soft magnetism interference correlation matrix (including the environmental magnetic field factor, material factor itself) with
Measured magnetic field carries out matrix operation, completes compensation function;
(7) temperature error:Input temp error parameter, running temperature error routine pass through temperature error parameter and magnetic field
Measured value, inclination angle measured value carry out the algorithm matrix operation, and the factors such as the temperature drift of Magnetic Sensor and obliquity sensor are caused
Azimuth angle error compensate, complete temperature change caused by azimuth angle error compensating.
Embodiment 3:Referring to Fig. 7, by embodiment 2 it is found where there is significant deficiency, that is, can not turn after carrier installation
It is dynamic, it cannot achieve internal calibrations program.
At this point, before azimuth solves, first increase by first judgement, host computer inputs the finger of " whether needing to correct "
It enables, after microprocessor receives, if without correction, directly solves posture using the error parameter combination azimuth solution to prestore
If desired angle information corrects, then enter next judgement, passes through the instruction of external auxiliary correction mode or internal autonomy straightening die
Formula instructs to correct, we set the instruction of external auxiliary correction mode as pattern 1, and the instruction of internal autonomy correction mode is pattern 2, if
It is corrected using pattern 1, specific method is corrected referring to embodiment 1 according to pattern 2, then referring to embodiment 2.
Claims (5)
1. a kind of bearing calibration of electronic compass, including electronic compass, the electronic compass includes body, cover board and is located at body
Interior circuit unit, it is characterised in that:The circuit unit include data acquisition circuit, microprocessor, serial communication circuit and
Power circuit, the data acquisition circuit include magnetic sensor and obliquity sensor, and the magnetic sensor is for obtaining
The three axis earth's magnetic field value of the earth of current environment is taken, and is sent into microprocessor after signal conditioning circuit, A/D conversion circuits, institute
Terrestrial gravitation acceleration value of the obliquity sensor for obtaining current environment is stated, and is converted into inclination value, is sent into microprocessor, institute
The serial ports for stating microprocessor is connect with serial communication circuit, and the serial communication circuit with host computer for communicating, the shell
Side is equipped with communication interface plug-in unit, and the communication interface plug-in unit is for connecting serial communication circuit and power circuit;
The bearing calibration of the electronic compass includes the following steps:
(1) system initialization obtains the error of zero parameter of electronic compass, sensitivity error parameter, quadrature error parameter, installs
Error parameter, temperature error parameter, prestore as basic error parameter into microprocessor, are sensed by Magnetic Sensor and inclination angle
Device obtains the magnetic field data of Earth and inclination data of current environment respectively, is sent into microprocessor;
(2) microprocessor carries out pour angle compensation using inclination data to magnetic field data, then will be after inclination data and compensation
Magnetic field data carries out data prediction;
(3) azimuth solution is carried out according to the data that step (2) obtains;Export the azimuth number compensated without correction parameter
According to;
(4) Hard Magnetic mushing error parameter, the soft magnetism mushing error parameter for obtaining erecting bed constitute error with pedestal error parameter
Parameter;
(5) error parameter is utilized, error compensation is carried out to the data of step (3), obtains attitude angle data;
(6) attitude angle data obtained according to step (5), in conjunction with posture position compensation method, by actual coordinates coordinate origin
Move to measuring coordinate system origin.
2. the bearing calibration of electronic compass according to claim 1, it is characterised in that:Step (2) pour angle compensation
Specific method is:
(21) magnetic field strength component X, Y, Z of tri- axis of carrier coordinate system X, Y, Z are measured using magnetic sensor;
(22) gravitational acceleration component Ax, Ay, Az of tri- axis of carrier X, Y, Z is measured by obliquity sensor, it is several in conjunction with space
What calculates roll angle θ and pitch angle δ, formula are as follows:
(23) slope compensation
By the roll angle and pitch angle measured, in conjunction with magnetic field strength component X, Y, the Z measured, according to vector triangle, by it
The horizontal magnetic intensity X being transformed under terrestrial coordinate systemHAnd YH;
XH=Xcos (δ)+Ysin (θ) sin (δ)-Zcos (θ) sin (δ) (3)
YH=Ycos (θ)+Zsin (θ) (4)
3. the bearing calibration of electronic compass according to claim 1, it is characterised in that:Azimuth is asked in the step (3)
The specific method of solution is:
The X that formula (3) and (4) are found outHAnd YH, bring following formula into and find out azimuth angle alpha:
4. the bearing calibration of electronic compass according to claim 1, it is characterised in that:In the step (6), in conjunction with posture
Position compensation method is specially:
Measuring coordinate system is (x, y, z), and the attitude angle data that step (5) obtains isDisplacement data between the two isNew coordinate after translation is
Coordinate system (x after translation2,y2,z2) with the relationship of measuring coordinate system (x, y, z) be:
1) the rotation alpha angles counterclockwise about the z axis coordinate system XYZ, are transformed to coordinate system X1Y1Z;
2) coordinate system X1Y1Z is around Y1Axis is counterclockwise rotation β angle, is transformed to coordinate system X2Y1Z1;
3) coordinate system X2Y1Z1Around X2Axis rotates the angles γ counterclockwise, is transformed to coordinate system X2Y2Z2;
Rotation angle α, β, γ in above-mentioned rotary course are known as " Euler's rotation angle ", are provided by electronic compass, measuring coordinate system (x,
Y, z) pass through the coordinate system (x three times after reference axis rotation transformation to translation2,y2,z2) in, above-mentioned rotary course matrix phase
The form multiplied is expressed as
It enables
Coordinate in measuring coordinate system is
5. the bearing calibration of electronic compass according to claim 1, it is characterised in that:The body, which is adopted, to be formed from aluminium, lid
Sealing ring is equipped between plate and body.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810385964.0A CN108507553A (en) | 2018-04-26 | 2018-04-26 | The bearing calibration of electronic compass |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810385964.0A CN108507553A (en) | 2018-04-26 | 2018-04-26 | The bearing calibration of electronic compass |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108507553A true CN108507553A (en) | 2018-09-07 |
Family
ID=63399279
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810385964.0A Pending CN108507553A (en) | 2018-04-26 | 2018-04-26 | The bearing calibration of electronic compass |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108507553A (en) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110160497A (en) * | 2019-06-20 | 2019-08-23 | 惠州市博实结科技有限公司 | Iron tower incline measurement method, device, computer equipment and storage medium |
CN110207684A (en) * | 2019-07-11 | 2019-09-06 | 中航通飞华南飞机工业有限公司 | A kind of airborne radio direction finder outfield automated calibration system and method |
CN110702086A (en) * | 2019-11-08 | 2020-01-17 | 苏州市方普电子科技有限公司 | Efficient detection equipment and detection method for electronic compass of remote controller |
CN110954081A (en) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | Quick calibration device and method for magnetic compass |
CN110954080A (en) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | Magnetic compass calibration method for eliminating carrier magnetic interference |
CN111078489A (en) * | 2018-10-19 | 2020-04-28 | 宏达国际电子股份有限公司 | Electronic device and attitude correction method thereof |
CN111337870A (en) * | 2020-04-17 | 2020-06-26 | 中国人民解放军海军装备部驻沈阳地区军事代表局驻大连地区第一军事代表室 | Three-axis electric field correction method based on Euler formula |
CN111765879A (en) * | 2019-11-29 | 2020-10-13 | 深圳市瑞芬科技有限公司 | Three-dimensional electronic compass device and practical calibration method |
CN111780746A (en) * | 2020-03-27 | 2020-10-16 | 宁波小遛共享信息科技有限公司 | Direction angle detection method and device, electronic equipment and travel tool |
CN111982155A (en) * | 2020-08-27 | 2020-11-24 | 北京爱笔科技有限公司 | Calibration method and device of magnetic sensor, electronic equipment and computer storage medium |
CN111998848A (en) * | 2020-08-28 | 2020-11-27 | 北京信息科技大学 | Ground rolling direction determining method and device |
CN113218380A (en) * | 2021-05-21 | 2021-08-06 | 北京百度网讯科技有限公司 | Electronic compass correction method and device, electronic equipment and storage medium |
RU2755400C1 (en) * | 2020-07-16 | 2021-09-15 | Акционерное общество "Уральское производственное предприятие "Вектор" (АО "УПП "Вектор") | Method for operational calibration of triaxial electronic compass with axis displacement compensation |
CN113916207A (en) * | 2021-08-27 | 2022-01-11 | 嘉兴市纳杰微电子技术有限公司 | High-precision electronic compass calibration method with inclination angle compensation |
CN114034279A (en) * | 2021-10-25 | 2022-02-11 | 南京百花光电有限公司 | Method and device for realizing high-precision orientation of electronic compass by combining photoelectric angle measurement information |
CN117537792A (en) * | 2024-01-03 | 2024-02-09 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) | Electronic compass self-adaptive azimuth correction method |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102197277A (en) * | 2008-10-21 | 2011-09-21 | 罗伯特·博世有限公司 | Electronic compass |
CN102313543A (en) * | 2011-07-11 | 2012-01-11 | 上海大学 | Magnetic azimuth measuring system based on giant magneto-resistance sensor, measurement method and perpendicular compensation method |
CN103630137A (en) * | 2013-12-02 | 2014-03-12 | 东南大学 | Correction method used for attitude and course angles of navigation system |
CN104748734A (en) * | 2015-04-17 | 2015-07-01 | 苏州健雄职业技术学院 | Vehicle-mounted electronic altitude compass having dip angle compensation function |
CN104792301A (en) * | 2015-04-22 | 2015-07-22 | 华中科技大学 | Method and device for correcting azimuth of borehole television probe under ferromagnetic interference |
CN106569150A (en) * | 2016-11-02 | 2017-04-19 | 南京理工大学 | Two-step simple correction method for triaxial magnetic sensor |
CN107727091A (en) * | 2017-09-07 | 2018-02-23 | 山东省科学院海洋仪器仪表研究所 | The anti-collision prevention system and method for ocean monitoring buoy based on three axle geomagnetic sensors |
-
2018
- 2018-04-26 CN CN201810385964.0A patent/CN108507553A/en active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102197277A (en) * | 2008-10-21 | 2011-09-21 | 罗伯特·博世有限公司 | Electronic compass |
CN102313543A (en) * | 2011-07-11 | 2012-01-11 | 上海大学 | Magnetic azimuth measuring system based on giant magneto-resistance sensor, measurement method and perpendicular compensation method |
CN103630137A (en) * | 2013-12-02 | 2014-03-12 | 东南大学 | Correction method used for attitude and course angles of navigation system |
CN104748734A (en) * | 2015-04-17 | 2015-07-01 | 苏州健雄职业技术学院 | Vehicle-mounted electronic altitude compass having dip angle compensation function |
CN104792301A (en) * | 2015-04-22 | 2015-07-22 | 华中科技大学 | Method and device for correcting azimuth of borehole television probe under ferromagnetic interference |
CN106569150A (en) * | 2016-11-02 | 2017-04-19 | 南京理工大学 | Two-step simple correction method for triaxial magnetic sensor |
CN107727091A (en) * | 2017-09-07 | 2018-02-23 | 山东省科学院海洋仪器仪表研究所 | The anti-collision prevention system and method for ocean monitoring buoy based on three axle geomagnetic sensors |
Non-Patent Citations (1)
Title |
---|
陈伟韬: "基于MEMS传感器的电子罗盘系统的设计" * |
Cited By (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111078489A (en) * | 2018-10-19 | 2020-04-28 | 宏达国际电子股份有限公司 | Electronic device and attitude correction method thereof |
CN111078489B (en) * | 2018-10-19 | 2023-03-10 | 宏达国际电子股份有限公司 | Electronic device and attitude correction method thereof |
CN110160497A (en) * | 2019-06-20 | 2019-08-23 | 惠州市博实结科技有限公司 | Iron tower incline measurement method, device, computer equipment and storage medium |
CN110207684A (en) * | 2019-07-11 | 2019-09-06 | 中航通飞华南飞机工业有限公司 | A kind of airborne radio direction finder outfield automated calibration system and method |
CN110207684B (en) * | 2019-07-11 | 2021-10-15 | 中航通飞华南飞机工业有限公司 | Automatic calibration system and method for outfield of airborne radio compass |
CN110702086A (en) * | 2019-11-08 | 2020-01-17 | 苏州市方普电子科技有限公司 | Efficient detection equipment and detection method for electronic compass of remote controller |
CN111765879A (en) * | 2019-11-29 | 2020-10-13 | 深圳市瑞芬科技有限公司 | Three-dimensional electronic compass device and practical calibration method |
CN110954081A (en) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | Quick calibration device and method for magnetic compass |
CN110954080A (en) * | 2019-12-25 | 2020-04-03 | 中国船舶重工集团有限公司第七一0研究所 | Magnetic compass calibration method for eliminating carrier magnetic interference |
CN111780746A (en) * | 2020-03-27 | 2020-10-16 | 宁波小遛共享信息科技有限公司 | Direction angle detection method and device, electronic equipment and travel tool |
CN111337870A (en) * | 2020-04-17 | 2020-06-26 | 中国人民解放军海军装备部驻沈阳地区军事代表局驻大连地区第一军事代表室 | Three-axis electric field correction method based on Euler formula |
CN111337870B (en) * | 2020-04-17 | 2021-07-06 | 中国人民解放军海军装备部驻沈阳地区军事代表局驻大连地区第一军事代表室 | Three-axis electric field correction method based on Euler formula |
RU2755400C1 (en) * | 2020-07-16 | 2021-09-15 | Акционерное общество "Уральское производственное предприятие "Вектор" (АО "УПП "Вектор") | Method for operational calibration of triaxial electronic compass with axis displacement compensation |
CN111982155A (en) * | 2020-08-27 | 2020-11-24 | 北京爱笔科技有限公司 | Calibration method and device of magnetic sensor, electronic equipment and computer storage medium |
CN111982155B (en) * | 2020-08-27 | 2022-08-12 | 北京爱笔科技有限公司 | Calibration method and device of magnetic sensor, electronic equipment and computer storage medium |
CN111998848A (en) * | 2020-08-28 | 2020-11-27 | 北京信息科技大学 | Ground rolling direction determining method and device |
CN113218380A (en) * | 2021-05-21 | 2021-08-06 | 北京百度网讯科技有限公司 | Electronic compass correction method and device, electronic equipment and storage medium |
CN113916207A (en) * | 2021-08-27 | 2022-01-11 | 嘉兴市纳杰微电子技术有限公司 | High-precision electronic compass calibration method with inclination angle compensation |
CN114034279A (en) * | 2021-10-25 | 2022-02-11 | 南京百花光电有限公司 | Method and device for realizing high-precision orientation of electronic compass by combining photoelectric angle measurement information |
CN114034279B (en) * | 2021-10-25 | 2023-08-04 | 南京百花光电有限公司 | Method and device for realizing high-precision orientation of electronic compass by combining photoelectric angle measurement information |
CN117537792A (en) * | 2024-01-03 | 2024-02-09 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) | Electronic compass self-adaptive azimuth correction method |
CN117537792B (en) * | 2024-01-03 | 2024-04-30 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) | Electronic compass self-adaptive azimuth correction method |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108507553A (en) | The bearing calibration of electronic compass | |
CN105378429B (en) | Automatic compass calibration system and corresponding method | |
CN106525073B (en) | A kind of inertial space Gyro Calibration test method based on three-axle table | |
Vasconcelos et al. | Geometric approach to strapdown magnetometer calibration in sensor frame | |
CN105425764B (en) | A kind of three axis magnetometer closed loop test system and method based on dynamically magnetic simulation | |
CN1323282C (en) | Apparatus and method of compensating for the attitude change of an earth magnetic sensor | |
CN102313543B (en) | Magnetic azimuth measuring system based on giant magneto-resistance sensor, measurement method and perpendicular compensation method | |
CN107544042B (en) | Magnetometer array correction method | |
CN106200614B (en) | A kind of spacecraft attitude control test macro and method using the true torque of control-moment gyro | |
JPH0340323B2 (en) | ||
CN106767804A (en) | The multidimensional data measurement apparatus and method of a kind of moving object | |
CN110926468A (en) | Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment | |
CN111238529B (en) | Attitude measuring instrument precision calibration device and method based on starlight measurement | |
JPS59155714A (en) | Electronic compass for transportation facility | |
CN110017812B (en) | Measuring device and method for vertical line deviation, gravitational acceleration and gravity gradient | |
CN107132587B (en) | The full tensor magnetic gradient measurements system mounting error calibration method of aviation superconduction and device | |
GB2460161A (en) | Gimbal system angle compensator | |
CN109444774B (en) | Method for measuring magnetic field noise coefficient of underwater vehicle based on small signal method | |
CN110134134A (en) | A kind of wind detection method under unmanned plane floating state | |
CN114674301A (en) | Electronic compass active compensation method and system under strong magnetic interference environment | |
CN110736484A (en) | Background magnetic field calibration method based on fusion of gyroscope and magnetic sensor | |
CN208269926U (en) | electronic compass | |
CN112379603B (en) | Compensating system and method for installation eccentricity of strapdown seeker in radio frequency guidance simulation | |
CN111982155B (en) | Calibration method and device of magnetic sensor, electronic equipment and computer storage medium | |
CN117053829A (en) | Magnetic heading joint calibration method and device, electronic equipment and storage medium |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180907 |
|
RJ01 | Rejection of invention patent application after publication |