CN1096581A - Component magnetometer correction method and correctable device - Google Patents

Abstract

The invention discloses a kind of magnetometer correction method that can accurately revise manufacturing, installation and carrier magnetic interference error, comprise according to the correction formula of 12 constant calculations with according to choosing orientation data that attitude is surveyed wantonly and find the solution the equation of 12 constants.Being suitable on magnetic carrier strapdown installs and not disturbed by its operation, reduction is to the requirement of magnetometer and corollary system, improve flight path magnetic field and orientation attitude measurement accuracy, and can constitute magnetic---inertia orientation attitude and navigational system, realization is from normal moveout correction, the calculating of orientation attitude remaining, elimination accumulation drift error, the substantial magnetic field data storehouse of automatic correction, needn't require its integrity, can be in magnetic anomaly district operate as normal.

Description

Component magnetometer correction method and correctable device

The present invention relates to the component magnetometer that a kind of probe strapdown on carrier installs bearing calibration, use the component magnetometer of this bearing calibration and use the device of this magnetometer, comprise canonical systems such as flight path environmental magnetic field automatic measurement system, magnetic azimuth system (strapdown compass), strapdown deviational survey orientation system, magnetic-inertia orientation attitude system and magnetic-inertial navigation system.

Component magnetometer not only is used for magnetic survey, and is used to measure carrier orientation attitude, but existing component magnetometer service precision is not high, lacks accurate bearing calibration, seriously harms its application on the high-acruracy survey engineering and the carrier that disturbs that is magnetic.For example measure in the operation at the flight path environmental magnetic field, have to its probe is placed on place away from the motion carrier body, as be fixed on the guide rod end and launch satellite outside again, be suspended on the aircraft below, be supported on vehicle or naval vessel top etc., not only complex structure but also influence measuring accuracy and carrier moves; The component magnetometer that the probe strapdown is installed has good moving pedestal serviceability when being used to measure carrier orientation attitude, but can not continue to use the installation bearing calibration of traditional magnetic compass, so, use the strapdown compass of this magnetometer and the service precision of strapdown deviational survey orientation system and often can not meet the demands, in carrier magnetic field when more intense even can't use; The orientation attitude of application inertial sensor and the bearing accuracy of navigational system are relatively poor, use the environmental magnetic field data that higher attitude data of its precision and component magnetometer are measured, according to the computer azimuth angle of coordinate transform formula, be used to carry out alignment of orientation, be present most popular scheme; The orientation attitude data that inertia system provides has the accumulation drift error, and component magnetometer is used to measure the orientation attitude and does not have cumulative errors, just in time can remedy it, constitutes magnetic-inertia system.Home and abroad aeronautical engineering circle or has been developed this novel orientation attitude and navigational system, but because of the service precision of magnetometer can not meet the demands, fails so far formally to use.Other two technical barriers-flight path environmental magnetic field data imperfection of magnetic-inertia orientation attitude and navigational system is inaccurate (for example: the magnetic map that the terrestrial magnetic field data can only rely on earth magnetism monitoring department to provide; obviously apply not need) and during by the magnetic anomaly district orientation attitude data insincere, also be difficult to solve because of the component magnetometer service precision is not high.

The purpose of this invention is to provide the precision correcting method of component magnetometer and can thoroughly revise the high precision component magnetometer of its foozle, alignment error and carrier magnetic interference error and use the various systems of this magnetometer, comprise magnetic-inertia orientation attitude and the navigational system that provides a kind of and can accurately proofread and correct, improve automatically flight path environmental magnetic field database automatically and eliminate the influence of magnetic anomaly district.

In order to achieve the above object, the precision correcting method of component magnetometer of the present invention comprises:

A) be installed in component magnetometer on the carrier and place and proofread and correct ground, change the orientation attitude of carrier, write down each stack orientations attitude data and corresponding component magnetometer measured data;

B) according to the environmental magnetic field data of proofreading and correct ground and each stack orientations attitude data, use the coordinate transform formula, calculate the component magnetometer corresponding and should survey the environmental magnetic field component data with each stack orientations attitude data;

C) component magnetometer of each stack orientations attitude correspondence is surveyed three-dimensional data H _Mx, H _My, H _McWith should survey three-dimensional data H _x, H _y, H _zSubstitution correction constant basic calculating formula

f _xxH _x+f _xyH _y+f _xzH _z+F _x＝H _mx

f _yxH _x+f _yyH _y+f _yzH _x+F _y＝H _my

f _zxH _z+f _xyH _y+f _zzH _z+F _z＝H _mz

Obtain respectively to revise constant f _Xx, f _Xy, f _Xz, F _xOr f _Yx, f _Yy, f _Yz, F _yOr f _Zx, f _Zy, f _Zz, F _zEquation for unknown number;

D) according to the above-mentioned solving simultaneous equation correction constant corresponding with four groups or more stack orientations attitudes;

When the simultaneous equations number surpassed four, by combination principle, the relevant constant of revising of optional earlier four solving simultaneous equations asked each to revise the assembly average of separating of all combinations of constant again, uses for corrected Calculation;

When carrier inconvenience changes orientation attitude and magnetometer precision and can meet the demands, given f _Xx=f _Yy=f _Zz=1, f _Xy=f _Xz=f _Yz=f _Zx=f _Xy=0, according to the above-mentioned Equation for Calculating correction constant F of any stack orientations attitude correspondence _x, F _y, F _z, or under many stack orientations attitude, determine F respectively _x, F _y, F _z, ask its assembly average again;

E) according to calibrated definite correction constant, use basic correction formula

Calculate component magnetometer and should survey the three-dimensional data H of local environment magnetic field intensity _x, H _y, H _z;

When institute's school magnetic strength is counted the three-component magnetometer, the transformation for mula of available above-mentioned basic correction formula

Directly find the solution H _z, H _y, H _zOr be used to calculate other data;

When institute's school magnetic strength is counted two components or simple component magnetometer, with the discrete formula of above-mentioned basic correction formula

f _xxH _x+f _xyH _y+f _xzH _z＝H _mx-F _x

f _yxH _x+f _yyH _y+f _yzH _z＝H _my-F _y

f _zxH _x+f _zyH _y+f _zzH _z＝H _mz-F _s

In the formula relevant and one or two with this magnetometer measured data calculate H according to local environment magnetic field data and carrier orientation attitude data _xAnd/or H _yAnd/or H _zThe coordinate transform formula, simultaneous solution H _xAnd/or H _yAnd/or H _z

When the magnetometer precision can meet the demands, from above-mentioned discrete formula deletion its do not survey the component correspondence should survey component terms, directly find the solution.

Use the component magnetometer of above-mentioned bearing calibration and comprise that the device of this magnetometer is equipped with after sampling apparatus and the computing machine, just can revise the magnetometer measured data automatically.This computing machine has the specific address of storage magnetometer correction constant, this specific address can be saved in stored data before the next calibration modifications always, after a, b, c, d proofread and correct and calculate as stated above at every turn, deposit the specific address of computing machine in or revise the data that deposit in before this revising constant; This computing machine also is provided with the calculation procedure of the described magnetometer correction formula of said method e.

The bearing calibration of component magnetometer of the present invention, the advantage of using the magnetometer of this bearing calibration and using the device of this magnetometer are: (1) can thoroughly revise foozle, alignment error and the carrier magnetic interference error of magnetometer; (2) manufacturing and installation accuracy requirement have been reduced to magnetometer; (3) timing only needs arbitrarily to change the orientation attitude of carrier, and automatically calibrating; (4) owing to realized high-acruracy survey and allowed carrier to have, enlarged range of application than ferromagnetism; (5) owing to improved the magnetometer service precision, can constitute magnetic-inertia orientation attitude and navigational system, realize the calculating of orientation attitude weighting remaining, eliminate the accumulation drift error, reduce the accuracy requirement of inertial sensor and inertial navigation system or obtain higher precision, can under the coarse situation of environmental magnetic field database imperfection, begin to come into operation and the energy self-perfection, not influence performance when entering the magnetic anomaly district.

Be embodiment with magnetic air-inertial navigation system below, the present invention is described in further detail.

Fig. 1 is the operation program block diagram that magnetic-inertial navigation system navigational computer is set up.

This system is made of three-component magnetometer, inertial navigation system and mode selector; The sampling apparatus of inertial navigation system is held concurrently the magnetometer measured data is carried out synchronized sampling, and navigational computer adds magnetometer correction constant calculations program, alignment of orientation program, orientation attitude weighting remaining calculation procedure, pure inertia work branch state computation program, can be saved to correction next time, the magnetometer correction constant specific address of revising and geomagnetic field intensity at geographic coordinate system (right-handed system) three direction of principal axis component H _Xo, H _Yo, H _ZoThe magnetic map database.

Mode selector is provided with " correction " and two status commands of " RUN "; Above-mentioned magnetometer correction constant calculations program is carried out in the instruction of the direct receive status selector switch of navigational computer, correcting state, and running status is carried out above-mentioned orientation attitude weighting remaining calculation procedure or pure inertia work branch state computation program.

Three sensitive axes of three-component magnetometer probe are aimed at aircraft axes (right-handed system) three direction of principal axis and are installed.

Aircraft true bearing ψ, roll γ and the pitching θ of native system definition meet following regulation: be ψ=γ=θ=0 when aircraft axes overlap with geographic coordinate system, aircraft orientation attitude thus turns over ψ around self vertical pivot, turn over γ around self longitudinal axis again, turn over θ around self transverse axis at last, arrive real-time orientation attitude.

The principle formula that native system is suitable for is as follows:

According to H _Xo, H _Yo, H _ZoCalculate the three-component magnetometer and should survey data H _x, H _y, H _zFormula: use the coordinate transform formula,

The basic correction formula of strapdown three-component magnetometer:

H wherein _Mx, H _My, H _Mz-three-component magnetometer measured data;

F _x, F _y, F _z, f _Xx, f _Xy, f _Xz, f _Yx, f _Yy, f _Yz, f _Zx, f _Zy, f _Zz-correction constant.

Revise the constant basic calculating formula: according to formula (1), (2),

∴f _xx[（H _xocosψ+H _yosinψ）cosθ-（H _xosinψ-H _yocosψ）sinθsinγ-H _zosinθcosγ]+

+f _xy[-（H _xosinψ-H _yocosψ）cosγ+H _zosinγ]+

+f _xz[（H _xocosψ+H _yosinψ）sinθ+（H _xosinψ-H _yocosψ）cosθsinγ+H _zocosθcosγ]+

+F _x＝H _mx（4）

f _yx[（H _xocosψ+H _yosinψ）cosθ-（H _xosinψ-H _yocosψ）sinθsinγ-H _zosinθcosγ]+

+f _yy[-（H _xosinψ-H _yocosψ）cosγ+H _zosinγ]+

+f _yz[（H _xocosψ+H _yosinψ）sinθ+（H _xosinψ-H _yocosψ）cosθsinγ+H _zocosθcosγ]+

+F _y＝H _my（5）

f _zx[（H _xocosψ+H _yosinψ）cosθ-（H _xosinψ-H _yocosψ）sinθsinγ-H _zosinθcosγ]+

+f _zy[-（H _zosinψ-H _yocosψ）cosγ+H _zosinγ]+

+f _zz[（H _xocosψ+H _yosinψ）sinθ+（H _xosinψ-H _yocosψ）cosθsinγ+H _zocosθcosγ]+

+F _z＝H _mz（6）

The magnetometer correction formula: according to formula (2),

According to H _x, H _y, H _z, H _Xo, H _Yo, H _ZoCalculate true bearing ψ _M, roll γ _M, pitching θ _MFormula: use the coordinate transform formula,

${\psi }_M\mathrm{=\; t\; g}{}^{\mathrm{-1}}\frac{{\mathrm{(\; -\; H}}_X{\mathrm{s\; i\; n\theta \; +\; H}}_z{\mathrm{c\; o\; s\; \theta \; )\; s\; i\; n\; \gamma \; -\; H}}_y\mathrm{c\; o\; s\; \gamma }}{H_X{\mathrm{c\; o\; s\; \theta \; +\; H}}_Z\mathrm{s\; i\; n\; \theta }}{\mathrm{+\; t\; g}}^{\mathrm{-1}}\frac{H_{\mathrm{y\; o}}}{H_{\mathrm{Z\; O}}}\mathrm{(\; 8\; )}$

${\gamma }_M\mathrm{=\; t\; g}{}^{\mathrm{-1}}\frac{H_X{\mathrm{s\; i\; n\theta \; -\; H}}_z\mathrm{c\; o\; s\; \theta }}{H_y}{\mathrm{+\; t\; g}}^{\mathrm{-1}}\frac{H_{\mathrm{z\; o}}}{{\mathrm{-\; H}}_{\mathrm{xO}}{\mathrm{s\; i\; n\; \psi \; +\; H}}_{\mathrm{y\; o}}\mathrm{c\; o\; s\; \psi }}\mathrm{(\; 9\; )}$

${\theta }_M\mathrm{=\; t\; g}{}^{\mathrm{-1}}\frac{{\mathrm{-\; H}}_X}{H_X}{\mathrm{+\; t\; g}}^{\mathrm{-1}}\frac{H_{\mathrm{x\; o}}{\mathrm{cos\; \psi \; +\; H}}_{\mathrm{y\; o}}\mathrm{s\; i\; n\; \psi }}{{\mathrm{(H}}_{\mathrm{x\; o}}{\mathrm{s\; i\; n\psi \; -\; H}}_{\mathrm{y\; o}}{\mathrm{cos\; \psi \; )s\; i\; n\; \gamma \; +\; H}}_{\mathrm{z\; o}}\mathrm{c\; o\; s\; \gamma }}\mathrm{(\; 10\; )}$

According to H _x, H _y, H _z, ψ, γ, θ calculate H _Xo, H _Yo, H _ZoFormula: use the coordinate transform formula,

∴H _xo＝H _x（cosθcosψ-sinθsinγsinψ）-H _ycosγsinψ+H _z（sinθcosψ+cosθsinγsinψ） （12）

H _yo＝H _x（cosθsinψ+sinθsinγcosψ）+H _ycosγcosψ+H _z（sinθsinψ-cosθsinγ-cosθsinγcosψ） （13）

H _zo＝-H _xsinθcosγ+H _ysinγ+H _zcosθcosγ （14）

Correcting measuring calculates the step of magnetometer correction constant:

1) aircraft is placed correction ground;

2) start on magnetic-inertial navigation system and the aircraft all in working order the magnetic influence be different from machinery, power, the electrical equipment of stationary state;

3) rely on terrestrial reference or testing meter and instrument to finish the accurate aligning or the correction of inertial navigation system orientation attitude;

4) aircraft is when proofreading and correct ground or lift-off change orientation attitude, and the operation state selector switch makes navigational computer change correcting state over to, carries out the calculation procedure of following magnetometer correction constant.

The calculation procedure of magnetometer correction constant: the true bearing ψ that calculates gained according to inertial navigation system _N, roll γ _N, pitching θ _N, synchronously sampled data H _Mx, H _My, H _MzCorrection ground H with storage _Xo, H _Yo, H _Zo, by calculating shown in Figure 1, this program comprises:

1) the computed information H that will at every turn sample _Mx, H _My, H _Mz, ψ _N, γ _N, θ _NDeposit specified address in;

2) by combination principle, with optional four groups sampling computational data H _Mx, H _My, H _Mz, ψ _N, γ _N, θ _NAnd H _Xo, H _Yo, H _ZoDifference substitution formula (4), (5) and (6) are with ψ _N, γ _N, θ _NReplace wherein ψ, γ, θ respectively, respectively simultaneous solution correction constant; This program also can be divided into for two steps: first application formula (1) is calculated magnetometer should survey data H _x, H _y, H _z; Substitution formula again (2) simultaneous solution;

3) ask each to revise the assembly average of separating of all combinations of constant, deposit its specific address in;

4) calculating finishes, and navigational computer changes running status automatically over to.

Start working procedure:

1) attitude initial alignment: continue to use original method of inertial navigation system and program;

2) orientation initial alignment: carry out following alignment of orientation program;

3) normal operation: carry out following orientation attitude weighting remaining calculation procedure or pure inertia work and divide the state computation program;

4) navigator fix calculates: continue to use original method of inertial navigation system and program.

Alignment of orientation program: calculate gained and attitude data γ through aiming at according to inertial navigation system _No, θ _No, synchronously sampled data H _Mx, H _My, H _Mz, the storage H _Xo, H _YoWith 12 correction constants, by calculating shown in Figure 1.This program comprises:

1) according to γ _No, θ _No, H _Mx, H _My, H _Mz, H _Xo, H _Yo, application formula (7) and (8) are with γ _No, θ _NoReplace wherein γ, θ respectively, calculate ψ _MoProgram;

2) according to ψ _Mo, even the program that inertial navigation system is carried out alignment of orientation is its true bearing ψ through aiming at _No=ψ _Mo

Orientation attitude weighting remaining calculation procedure: navigational computer is carried out before the navigator fix calculation procedure, inserts weighting remaining computer azimuth attitude program.Calculate the ψ of gained according to inertial navigation system _N, γ _N, θ _N, synchronously sampled data H _Mx, H _My, H _Mz, the storage local H _Xo, H _Yo, H _ZoWith 12 correction constants, by calculating shown in Figure 1.This program comprises:

1) calculates gained ψ according to this (the 1st time) of inertial navigation system sampling _Ni, γ _Ni, θ _NiBefore this (the i time) calculate its accumulation drift error correction of gained △ ψ _Ni, △ γ _Ni, △ θ _Ni,, calculate the orientation attitude data after deduction is accumulated drift error according to following formula

ψ′ _Ni＝ψ _Ni+△ψ _Ni（15）

γ′ _Ni＝γ _Ni+△γ _Ni（16）

θ′ _Ni＝θ _Ni+△θ _Ni（17）

2) according to H _Mx, H _My, H _MzWith 12 correction constants, application formula (7) is calculated H _x, H _y, H _z;

3) according to H _x, H _y, H _z, H _Xo, H _Yo, H _Zo, use formula (8), (9) and (10) respectively, with ψ ' _Ni, γ ' _Ni, θ ' _NiReplace wherein ψ, γ, θ respectively, by γ ' _Ni, θ ' _NiCalculate ψ ' _Ni, by θ ' _Ni, ψ ' _NiCalculate γ ' _Ni, by ψ ' _Ni, γ ' _NiCalculate θ _Mi;

4) differentiate ψ _Mi, γ _Mi, θ _MiWhether correct, if

︱ψ _Mi-ψ′ _Ni|＞△ψ _Mm（18）

Or | γ _Mi-γ ' _Ni|＞△ γ _Mm(19)

Or | θ _Mi-θ ' _Ni|＞△ θ _Mm(20)

△ ψ wherein _Mm, △ γ _Mm, △ θ _MmThe H of-storage _Xo, H _Yo, H _ZoThe inaccurate ψ that causes _M, γ _M, θ _MError then changes pure inertia work over to and divides state, otherwise continues next step computing;

5) find the solution orientation attitude weighting remaining computational data according to following formula

ψ′ _i＝a _ψψ′ _Ni+b _ψψ _Mi（21）

γ′ _i＝a _γγ′ _Ni+b _γγ _Mi（22）

θ′ _i＝a _θθ′ _Ni+b _θθ _Mi（23）

A wherein _ψ, b _ψ, a _γ, b _γ, a _θ, b _θ-according to ψ _MWith ψ ' _N, γ _MWith γ ' _N, θ _MWith θ ' _NPrecision height and decide, and can according to move condition of work and working time section become, but should satisfy a _ψ+ b _ψ=1, a _γ+ b _γ=1, a _θ+ b _θ=1

Calculate gained ψ ' _i, γ ' _i, θ ' _iFor the usefulness that shows, controls and calculate navigation positioning data;

6), calculate inertial navigation system and accumulate the drift error correction in real time according to following formula

△ψ _Ni＝ψ′ _i-ψ _Ni（24）

△γ _Ni＝γ′ _i-γ _Ni（25）

△θ _Ni＝θ′ _i-θ _Ni（26）

Wherein the 1st sampled data is that inertial navigation system is finished the later sampled data of orientation attitude aligning, therefore given accumulation drift error △ ψ before this _No=△ γ _No=△ θ _No=0.

Calculate gained △ ψ _Ni, △ γ _Ni, △ θ _NiUsefulness for calculating next time.

Pure inertia work divides the state computation program: navigational computer is carried out and is calculated ψ ', γ ', θ ' and perfect, correction H _Xo, H _Yo, H _ZoProgram.By shown in Figure 1, calculate the ψ of gained according to inertial navigation system _N, γ _N, θ _N(the j time) calculates its accumulation drift error correction of gained △ ψ for the last time before this _N1, △ γ _N1, △ θ _N1Calculate ψ ', γ ', θ '; According to synchronized sampling computed information H _x, H _y, H _z, ψ ', γ ', θ ', calculate H _Zo, H _Yo, H _ZooThis program computation sequence is as follows:

1) according to ψ _Ni, γ _Ni, θ _Ni, △ ψ _Ni, △ γ _Ni, △ θ _Ni,, directly calculate according to following formula

ψ′ _i＝ψ _Ni+△ψ _Ni（27）

γ′ _i＝γ _Ni+△γ _Ni（28）

θ′ _i＝θ _Ni+△θ _Ni（29）

2) according to H _x, H _y, H _z, ψ ' _i, γ ' _i, θ ' _i, use formula (12), (13) and (14) respectively, with ψ ' _i, γ ' _i, θ ' _iReplace wherein ψ, γ, θ respectively, calculate H _Xo, H _Yo, H _Zo;

3) with H _Xo, H _Yo, H _ZoThe real-time sync bit data of aircraft according to inertial navigation system provides deposit the address of relevant position, geomagnetic data storehouse in, or revise wherein data.

Claims (8)

1, a kind of bearing calibration of the probe component magnetometer that strapdown is installed on carrier, it is characterized in that: this bearing calibration comprises

A) be installed in component magnetometer on the carrier and place and proofread and correct ground, change the orientation attitude of carrier, write down each stack orientations attitude data and corresponding component magnetometer measured data;

B) according to the environmental magnetic field data of proofreading and correct ground and each stack orientations attitude data, use the coordinate transform formula, calculate the component magnetometer corresponding and should survey the environmental magnetic field component data with each stack orientations attitude data;

C) component magnetometer of each stack orientations attitude correspondence is surveyed three-dimensional data H _Mx, H _My, H _MzWith should survey three-dimensional data H _x, H _y, H _zSubstitution correction constant basic calculating formula

f _xxH _x+f _xyH _y+f _xxH _z+F _x=H _mx

f _yxH _x+f _yyH _y+f _yzH _z+F _y=H _my

f _xxH _z+f _zyH _y+f _zzH _z+F _z=H _mz

Obtain respectively to revise constant f _Xx, f _Xy, f _Xz, F _xOr f _Yz, f _Yy, f _Yz, F _yOr f _Xx, f _Xy, f _Zz, F _zEquation for unknown number;

D) according to the above-mentioned solving simultaneous equation correction constant corresponding with four groups or more stack orientations attitudes; When the simultaneous equations number surpassed four, by combination principle, the relevant constant of revising of optional earlier four solving simultaneous equations asked each to revise the assembly average of separating of all combinations of constant again, uses for corrected Calculation;

When carrier inconvenience changes orientation attitude and magnetometer precision and can meet the demands, given f _Xx=f _Yy=f _Zz=1, f _Xy=f _Xz=f _Yx=f _Yz=f _Zx=f _Zy=0, according to the above-mentioned Equation for Calculating correction constant F of any stack orientations attitude correspondence _x, F _y, F _z, or under many stack orientations attitude, determine F respectively _x, F _y, F _z, ask its assembly average again;

E) according to calibrated definite correction constant, use basic correction formula

Calculate component magnetometer and should survey the three-dimensional data H of real time environment magnetic field intensity _x, H _y, H _z

When institute's school magnetic strength is counted the three-component magnetometer, with the transformation for mula of above-mentioned basic correction formula

Directly find the solution H _x, H _y, H _zOr be used to calculate other data;

When institute's school magnetic strength is counted two components or a component magnetometer, with the discrete formula of above-mentioned basic correction formula

f _xxH _x+f _xyH _z=H _mx-F _x

f _yzH _x+f _yyH _y+f _yzH _z=H _my-F _y

f _zxH _x+f _zyH _y+f _zzH _z=H _mz-F _z

In the formula relevant and one or two with this magnetometer measured data calculate H according to local environment magnetic field data and carrier orientation attitude data _xAnd/or H _yAnd/or H _zThe coordinate transform formula, simultaneous solution H _zAnd/or H _yAnd/or H _x

When the magnetometer precision can meet the demands, from above-mentioned discrete formula deletion its do not survey the component correspondence should survey component terms, directly find the solution.

2, application rights requires the component magnetometer of 1 described bearing calibration and comprises the device of this magnetometer, this magnetic strength is taken into account this device and is also comprised sampling apparatus and computing machine, it is characterized in that: this computing machine has the specific address of storage magnetometer correction constant, this specific address can be saved in stored data before the next calibration modifications always, after each described method of a, b, c, d of pressing in the claim 1 is proofreaied and correct and calculated, deposit the specific address of computing machine in or revise the data that deposit in before this revising constant; This computing machine also is provided with the calculation procedure of the described magnetometer correction formula of e in the claim 1.

3, device according to claim 2, this device also comprises inertial navigation system, pen recorder and computing machine, constitutes flight path environmental magnetic field automatic measurement system, it is characterized in that: the probe of this magnetometer directly is fixed on the carrier; This sampling apparatus is gathered the carrier orientation posture position data of magnetometer measured data and inertial navigation system calculating gained, this computing machine also is provided with the calculation procedure of coordinate transform formula, this program should be surveyed data computation environmental magnetic field data according to carrier orientation attitude and magnetometer, and deposits pen recorder together in the carrier real time position data.

4, device according to claim 2, one jiao, two jiaos or the inertial sensor of triangle data that provides in carrier position angle and attitude two angular datas also is provided this device, constitute magnetic-inertia orientation attitude system, it is characterized in that: except that two jiaos of the attitudes that provides according to inertial sensor are calculated the orientation attitude system of magnetic azimuth, this computer installation flight path environmental magnetic field database; This computing machine also is provided with the calculation procedure of coordinate transform formula, and this program is calculated remaining angular data according to a jiao of should survey that data and inertial sensor provide of local environment magnetic field data, the magnetometer of storage or two angular datas.

5, device according to claim 2, this device also comprises inertial navigation system, all sampling computing functions are finished by the related device of inertial navigation system, constitute magnetic-inertial navigation system, it is characterized in that: synchronous acquisition magnetometer data when the data sampling device of inertial navigation system is gathered its data; And the calculation procedure of flight path environmental magnetic field database and coordinate transform formula is set in computing machine; this program should be surveyed the attitude of carrier data computation bearing data that data and inertial navigation system are calculated gained according to local environment magnetic field data, the magnetometer of storage, as inertial navigation system alignment of orientation data.

6, flight path environmental magnetic field automatic measurement system according to claim 3, its computing machine also store proofreaies and correct ground environmental magnetic field data; Or magnetic according to claim 4-inertia orientation attitude system, whole three angular datas of its inertial sensor provider pose attitude; Or magnetic-inertial navigation system according to claim 5, it is characterized in that: this system also comprises mode selector, and this selector switch is provided with proofreaies and correct and moves two status commands, and the direct instruction computing machine is carried out correcting state program or running status program; Computing machine is also set up by the b in the claim 1, c, the described magnetometer correction of d constant calculations program, specializes in realization and uses from the correcting state of normal moveout correction.

7, orientation according to claim 4 attitude system, its orientation attitude sensor provides whole three angular datas; Or magnetic-inertial navigation system according to claim 5, it is characterized in that: computing machine also is arranged on to showing, control and calculating navigation positioning data provider pose attitude data and carry out the follow procedure that attitude weighting remaining in orientation is calculated before:

A) provide according to the orientation attitude sensor or inertial navigation system is calculated the real-time orientation attitude data of gained and is calculated its accumulation drift error correction of gained, the program of the orientation attitude data after the calculating deduction accumulation drift error before this;

B) should survey the local environment magnetic field data of data, storage and two angular datas in the orientation attitude data after the above-mentioned deduction accumulation drift error, applying a magnetic field strength component coordinate transform formula, the program of calculating third angle data according to magnetometer;

C) to after the above-mentioned deduction accumulation drift error and be weighted the remaining Program for Calculation according to the orientation attitude data that magnetic field data calculates gained, the weighting ratio is decided according to their precision height, and can according to the operation condition of work and working time section become, with the weighting remaining calculate gained orientation attitude data for show, control and calculate the usefulness of navigation positioning data;

D) the weighting remaining computational data with program c gained is as the criterion, and that the computer azimuth attitude sensor provides or inertial navigation system is calculated the program of real-time accumulation drift error correction of the real-time orientation attitude data of gained, and this correction is used for next computing.

8, orientation attitude system according to claim 7 or magnetic-inertial navigation system, it is characterized in that: computing machine is also inserting follow procedure between claim 7 a sequencer program b and the c: relatively after the deduction accumulation drift error and according to the orientation attitude data of magnetic patch data computation gained, when wherein the difference of arbitrary angular data surpasses given permissible error, change follow procedure a and b over to, otherwise still enforcement of rights requires 7 described program c and d;

Computing machine is also set up follow procedure:

A) that provide from the orientation attitude sensor or inertial navigation system is calculated the program that deduction the real-time orientation attitude data of gained calculates its accumulation drift error of gained before this for the last time, with by the orientation attitude data after the deduction accumulation drift error of this program gained for show, the program of the usefulness of control and calculating navigation positioning data;

B) should survey data according to the magnetometer of orientation attitude data after the deduction accumulation drift error of program a gained and synchronized sampling calculating gained, applying a magnetic field strength component coordinate transform formula, the program of calculating local environment magnetic field data;

To deposit the address of environmental magnetic field database relevant position by the local environment magnetic field data of this program gained in, or revise wherein data.

Images