Background technology
The mankind continue to develop, and in the field such as modern Aviation, space flight, navigation, geological prospecting, marine surveys, directional technology is essential, and azimuthal e measurement technology is more and more important.Azimuth measuring method common at this stage has:Gyroscope, radio heading device, GPS and magnetic course transmitter.The gyroscope degree of accuracy is high, good stability, but high cost, complex structure, and navigation error needs to carry out considerably complicated, careful initial alignment work with time integral.Radio heading device equipment is simple, but is susceptible to the interference of electromagnetic wave.GPS GPS accuracy is high, and round-the-clock positioning can be achieved, but there is city Grand Canyon effect, and GPS location can be caused to fail.Magnetic heading is to measure course using earth's magnetic field based on Magnetic Sensor, and simple in construction, signal is disposable, low cost, can directly measure carrier and magnetic field angle.Being commonly used for the geomagnetic sensor of magnetic heading needs the features such as high sensitivity, high-resolution, low-power consumption.
Conventional geomagnetic sensor can be classified as several at present:
1), fluxgate type compass, such as CN1971309 of patent 200610101789.5 is a kind of " geomagnetic sensor and its azimuth calculation method ".In fluxgate type compass, twin shaft metering system being used fluxgate sensor, it is internal using inclinometer device complex structure, and limited precision, dynamic property is poor, is not suitable for fast moving objects more.
2), reluctance type compass, with magnetoresistive transducer be measuring cell, no-rotary part, the small dynamic property of size is good, but conventional magnetoresistive element magneto-resistance effect only has 2%~3%, and resolution ratio is not high enough, measurement accuracy is shown in magnetic survey limited, it is impossible to realize high-precision magnetic survey.
In above-mentioned geomagnetic sensor, ground magnet-sensitive element complex structure, resolution ratio are low, bad dynamic performance, if there is also error for the measurement of the attitude data roll angle and the angle of pitch of equipment in geomagnetism detecting, it will carry out very big error to azimuthal measuring band, equipment precision is reduced.Regarding to the issue above, the present invention proposes a kind of magnetic azimuth angle measuring system based on giant magneto-resistance sensor and method, the features such as magnetic survey module has small volume, low cost, high precision.Meanwhile, using 3-axis acceleration sensor as posture measurement module, when overcoming two axle acceleration sensors as attitude measurement module, the non-monodrome problem of roll angle and the angle of pitch, so as to substantially increase magnetic azinuth measurement accuracy.
The content of the invention
The present invention is directed to the defect of prior art, proposes a kind of magnetic azimuth angle measuring system based on giant magneto-resistance sensor, measuring method and quadrature compensation method.On the basis of more accurate and more reliable using giant magneto-resistance sensor measurement earth's magnetic field, azimuthal uniqueness is realized with reference to 3-axis acceleration sensor, and nonopiate and zero drift is exported to three axle giant magnetoresistances compensate.
To reach above-mentioned purpose, idea of the invention is that:
When system carries out attitude data measurement, Sin sine relation is between the output and the angle of pitch, roll angle due to acceleration transducer, when double-axel acceleration sensor is as attitude measurement module, it may appear that the situation of the non-monodrome of the angle of pitch, roll angle.Simultaneously because being between magnetic survey data, the angle of pitch and roll angle and magnetic azinuth
Tangent relationship, obviously can there are problems that the non-monodrome of magnetic azinuth in the calculation, reduce the accuracy of magnetic azimuth angular measurement.
Giant magneto-resistance sensor utilizes the giant magneto-resistance sensor simultaneously Magnetic testi of three axial directions when carrying out magnetic survey.High-precision giant magneto-resistance sensor is generally difficult to avoid nonopiate phenomenon on three axial directions in the design, can cause non-orthogonal errors.Simultaneously as the giant magneto-resistance sensor on three axial directions has different zero drifts, these phenomenons will substantially reduce the magnetic survey precision of giant magneto-resistance sensor.
Conceived according to foregoing invention, the present invention uses following technical methods:
A kind of comprehensive measuring system of magnetic azinuth based on giant magneto-resistance sensor, is made up of power module, magnetic survey module, attitude measurement module, temperature-measuring module, microprocessor and host computer.Characterized in that, the power module provides 3.3V stabilized power sources for system;The magnetic survey module includes the signal processing circuit on X-axis, Y-axis and Z axis giant magneto-resistance sensor and correspondingly every axle;The attitude measurement module includes mutually orthogonal X, Y, Z 3-axis acceleration sensor;The magnetic survey module is connected to microprocessor A/D thief hatch;The attitude measurement module and temperature-measuring module are respectively connecting to the digital I/O port of microprocessor;The microprocessor is connected to host computer through RS232 mouthfuls.
The power supply mould uses voltage conversion chip 1117;The magnetic survey module uses three axle giant magneto-resistance sensor AAH002-02 connection RC low-pass filter circuits and instrument amplifier INA118;The attitude measurement module uses 3-axis acceleration sensor ADXL345;The temperature-measuring module uses temperature sensor DSB18B20;The microprocessor uses microprocessor MSP430F149, and after being pre-processed to Geomagnetism Information, pitch information and temperature information, magnetic azinuth is obtained after being handled by host computer.
One kind is based on giant magneto-resistance sensor magnetic azimuth angle measuring method, is detected using above-mentioned measuring system, it realizes comprising the following steps that for the comprehensive measurement in azimuth:
(1)Communication initialization between system initialization, including microprocessor and host computer, temperature sensor, 3-axis acceleration sensor, interrupts initialization;
(2)Microprocessor collection X-axis, Y-axis, the magnetic field data of Z axis
, system temperature data,
And gravitational acceleration component Ax, Ay, Az on three axial directions of acceleration transducer;
(3)Utilize geomagnetic field component
And the attitude information of 3-axis acceleration sensor, calculate the angle of pitch
And roll angle
, pass through model
Carry out azimuthal angle calculation.According to attitude information
With
And magnetic field data carries out azimuth
Comprehensive judgement.
(4)Export the unique azimuth of monodrome
。
The step(3)In, realize azimuth
Comprehensive judgement comprise the following steps that:
According to individual axis acceleration measuring principle, by handling the output signal of tri- axial directions of acceleration transducer ADL345, gravitational acceleration component Ax, Ay, Az of three axial directions are obtained.By formula
With
,
Calculate attitude angle.By the size to Ax, Ay, Az and it is positive and negative be combined differentiation, realize to the angle of pitch
And roll angle
Comprehensive judgement;
Microprocessor to Ax, Ay, Az by being more than 0, less than 0, equal to 0, equal to g, equal to-g, this 5 kinds of situations are combined differentiation, finally realizes to the angle of pitch
And roll angle
Comprehensive judgement;
Flatly magnetic component is calculated according to attitude data
, order
,
, use
By azimuth
It is divided into after 4 quadrants, by comparing
Size, and judge
It is positive and negative, determine azimuth
Occurrence.
A kind of magnetic azimuth angular measurement quadrature compensation method based on giant magneto-resistance sensor, for the three nonopiate and zero drift problem in axial direction in geomagnetic field measuring unit, three axles based on microprocessor are orthogonal and zero compensation specific method is, it is characterised in that:Defining the magnetic field amount that actual coordinate ox3y3z3 and ideal coordinates OX3Y3Z3 is exported on three axial directions of giant magneto-resistance sensor is respectively
With
;The angle that oy3 is projected with it on the OY3Z3 of face is
, its projection and OY3 angle are
;The angle that oz3 is projected with it on the OX3Z3 of face is
, its projection and OZ3 angle are
;The error of zero on the axle of giant magneto-resistance sensor three is made to be respectively
;Definition
Can be respectively the magnetic field value of actual and preferable output and the vector form of zero bias.Equation group can then be passed through
After repeatedly demarcation, the 4 angle values and 3 error of zero values in above-mentioned model are calculated, compensation matrix are then write into microprocessor, you can obtain preferable orthogonal measuring value.
The present invention is compared with prior art compared with having the following advantages that and good effect:
(1) giant magneto-resistance sensor substantially increases measurement sensitivity and systemic resolution as magnetic field measurement unit.
(2) the monodrome characteristic under roll angle and angle of pitch any combination is realized, it is ensured that system output azimuth monodrome is unique as Attitude Measuring Unit using 3-axis acceleration sensor.
(3) orthogonal and zero compensation is realized in the microprocessor, improves the reliability of measurement result.
(4) system possesses temperature measurement unit, temperature compensated system is applied to wider array of temperature range.
(5) low cost, it is low in energy consumption.
Embodiment
The preferred embodiments of the present invention are described with reference to the drawings as follows:
Embodiment one:
Referring to Fig. 1, this magnetic azimuth angle measuring system based on giant magneto-resistance sensor is by power module(1), magnetic survey module(2), attitude measurement module(3), temperature-measuring module(4), microprocessor(5)And host computer(6)Composition.The power module(1)3.3V stabilized power sources are provided for system;The magnetic survey module(2)Including X-axis, Y-axis and Z axis giant magneto-resistance sensor and correspondingly per axle on signal processing circuit;The attitude measurement module(3)Including mutually orthogonal X, Y, Z 3-axis acceleration sensor;The magnetic survey module(2)It is connected to microprocessor(5)A/D thief hatch;The attitude measurement module(3)And temperature-measuring module(4)It is respectively connecting to microprocessor(5)Digital I/O port;The microprocessor(5)Host computer is connected to through RS232 mouthfuls(6).
Embodiment two:
The present embodiment and embodiment one are essentially identical, and special feature is:The power module(1)Using voltage conversion chip 1117;The magnetic survey module(2)Using three axle giant magneto-resistance sensor AAH002-02 connection RC low-pass filter circuits and instrument amplifier INA118;The attitude measurement module(3)Using 3-axis acceleration sensor ADXL345;The temperature-measuring module(4)Using temperature sensor DSB18B20;The microprocessor(5)Using microprocessor MSP430F149, after being pre-processed to Geomagnetism Information, pitch information and temperature information, pass through host computer(6)Magnetic azinuth is obtained after processing.
Embodiment three:
This magnetic azimuth angle measuring method based on giant magneto-resistance sensor, using above-mentioned measuring system.
Magnetic azinuth measurement procedure is as shown in Fig. 2 the monodrome implementation process that Fig. 3 is directed to roll angle and the angle of pitch in the resolving of step 3 azimuth in Fig. 2 carries out refinement description, and Fig. 4 carries out refinement description for azimuthal monodrome implementation process in step 3 azimuth resolving in Fig. 2.The system magnetic azimuth angular measurement is comprised the following steps that:
(1)Such as the system initialization of Fig. 2 flows 1;
(2)As Fig. 2 flows 2 gather sensing data.Including:Geomagnetic data
, attitude data Ax, Ay, Az, temperature data T;
(3)Such as Fig. 2 flows 3 resolve magnetic azinuth, including:
As Fig. 3 obtains the unique angle of pitch of monodrome
And roll angle
Flow 1 reads data Ax, Ay, Az
Flow 2 brings Ax, Ay into equation respectively
Calculate
The angle of pitch
And roll angle
;
Flow 8 is worked as
Flow 9 is worked as
Flow 10 is worked as
As Fig. 4 obtains the unique magnetic azinuth of monodrome
Flow 1 reads earth magnetism and attitude data
Flow 2 calculates geomagnetism horizontal component
(4)Such as Fig. 2
flows 4, azimuth is exported
。
Example IV:
For above-mentioned measuring system, three axles based on microprocessor are orthogonal and zero compensation method is as follows:
Referring to Fig. 5, the axle of giant magneto-resistance sensor three is defined
Exporting magnetic field value is
The three axle errors of zero are respectively
;The axle of ideal quadrature three
Exporting magnetic field amount is
;Order
Axle with
Overlapping of axles,
Axle with
The angle of plane is
,
Axle is in face
On projection with
Angle be
;
Axle with
The angle of plane is
,
Axle is in face
On projection with
Angle be
;Then have:
Then
, order
, compensation matrix is write into microprocessor, you can calculate preferable orthogonal measuring value in the microprocessor
, so as to improve azimuth
Measurement accuracy.
As shown in fig. 6, three axles of this measuring system are orthogonal and zero compensation method demarcation flow is as follows:
Flow 1 installs measuring system by Fig. 5 requirements on calibrating table;
Flow 2 exists
Magnetic field is added on request on three axles
The record sensor output of
flow 3 ground magnetic value
Flow 4 repeats
flow 2 and
flow 3 has altogether 7 times(Change magnetic field intensity in prescribed limit every time), according to formula
Calculate 4 angles and 3 axle zero drifts;
4 flow of flow, 5 pairs of 4 angles are repeated several times in flow 5 and 3 axle zero drifts are averaged;
Flow 7 exports compensation model A, B matrix.