Background
The triaxial magnetic sensor can measure the coordinate value of the geomagnetic vector in a carrier coordinate system, and in the process of guiding drilling in oil drilling operation, the inclination angle and the inclination angle of different measuring points need to be measured for determining the track of a well bore, and in addition, the tool face angle of a guiding tool needs to be measured for controlling the deflecting direction. The well inclination angle, the well inclination azimuth angle and the tool face angle are navigation attitude parameters of the drilling tool, and the three-axis magnetic sensor is a commonly used drilling tool navigation attitude parameter sensor. The measuring process of the three-axis magnetic sensor is affected by production errors, installation errors and soft and hard magnetic interference, and in order to improve the measuring precision of the three-axis magnetic sensor, the three-axis magnetic sensor needs to be corrected to compensate various error influences. The correction method is an important factor for determining the error compensation effect, and in order to improve and verify various correction methods, correction experiments are required to obtain the measured values of the magnetic sensor in a plurality of attitude of the attitude heading reference point.
In the experiment of the document 1 (Zhang German, et al, component error two-step correction method of three-axis magnetic sensor, journal of sensing technology, 2018, 31 (11): 1707-1713), a place suitable for the experiment is selected by using a high-precision proton magnetometer outdoors, and then a three-axis non-magnetic turntable is used for changing the attitude of the magnetic sensor and measuring the experimental data. The disadvantages of this method are: the experiment needs to be carried out outdoors, so that a plurality of experimental devices are provided, and the transportation and power supply of the devices are inconvenient; the high-precision proton magnetometer and the three-axis nonmagnetic turntable have high cost; every experimental point all needs adjustment revolving stage angle in the experiment to record navigation appearance parameter and measuring signal, experiment complex operation and consuming time are long, easily receive external magnetic interference influence in long-time experiment process.
Document 2 (Rong Pengfei et al, vector calibration method for three-axis magnetic sensor orthogonality correction, proceedings of space science, 2018,38 (6): 953: 958) performed an experiment indoors, generated a known standard magnetic field source using a standard three-dimensional Helmholtz coil, and performed an experiment with the magnetic sensor installed in a standard magnetic field homogeneity region. The disadvantages of this method are: the Helmholtz coil has high cost and has certain requirements on the temperature of the use environment; changing the attitude of the magnetic sensor navigation attitude angle in the experiment needs to reinstall the magnetic sensor, and the standard magnetic field uniform area has smaller volume, so that the navigation attitude adjustment operation is complicated, and when a multi-attitude experiment is carried out, the experiment consumes long time.
In summary, the common disadvantages of the methods shown in the above documents include: error parameters of a three-axis magnetic sensor measurement model are not convenient to adjust, and particularly specific error parameters are adjusted; the experimental device has high cost, large volume and inconvenient movement; the experiment operation is complicated and takes a long time.
Disclosure of Invention
Aiming at the problems that in a correction experiment of a three-axis magnetic sensor, experimental data needs to be obtained by frequently adjusting the position of an entity device, error parameters are inconvenient to adjust, the experimental device is inconvenient to move, and the experiment cost is high, the invention provides the method for obtaining the simulation correction experimental data of the three-axis magnetic sensor.
The invention is realized by the following technical scheme:
a method for acquiring simulation correction experiment data of a three-axis magnetic sensor comprises the following steps:
(1) inputting parameters on an industrial computer: magnetic vector coordinates of reference coordinate system
(ii) a Duration of signal
Sampling interval
(ii) a The attitude and heading angle parameters comprise: course angle vector
Vector of pitch angle
Transverse roll angle vector
(ii) a Measuring error model parameters, including: hard magnetic interference
Soft magnetic interference matrix
Non-aligned matrix
Non-orthogonal matrix
Matrix of proportionality coefficients
Zero offset of sensor
Variance of Gaussian white noise
;
(2) Calculating the magnetic vector coordinates of a carrier coordinate system corresponding to the attitude vector: is provided with the first
Three parameters of each attitude and heading angle state: the course angle vector, the pitch angle vector and the roll angle vector are respectively
Then it is first
Magnetic vector coordinate of carrier coordinate system corresponding to each attitude of navigation attitude angle
The calculation formula of (A) is as follows:
(3) calculating magnetic vector coordinates of sensor coordinate system from error parameters
:
(4) The number of signal sampling points under each attitude and heading angle state can be obtained according to the signal duration and the sampling interval
Will be
Expansion into a matrix by number of sampling points
I.e. by
A matrix of which each column is
;
(5) Generation of noise sequences from gaussian white noise variance
And generates the sum
Sensor output signal corresponding to attitude of individual attitude heading reference
:
(6) And (5) calculating the sensor output signal corresponding to each attitude of the attitude heading reference model according to the steps (2) to (5), storing and displaying the signal calculation result, and simultaneously sending a simulation signal to a data interface.
Furthermore, an industrial control computer used in the method is an industrial control all-in-one machine.
The experimental device used by the method comprises a power supply interface, a charging power supply, an industrial control all-in-one machine and a data interface, wherein all the parts are arranged in a portable case and are used for power supply and signal connection in the case.
Compared with the prior art, the invention has the following beneficial effects:
(1) the data acquisition method can set attitude parameters and measurement error model parameters of the attitude and heading reference angle at will, and particularly can set specific types of error parameters, so that the method has the advantages of wide range of experimental conditions, specific parameter setting and complete experimental functions.
(2) According to the experimental method, various experimental parameters are input through the touch screen of the all-in-one machine, the experimental result is displayed on line, and the experimental operation is simple.
(3) The experimental device is small in size, light in weight, convenient to move, provided with a charging power supply and capable of working for a long time without external power supply.
Detailed Description
The present invention will be described in further detail with reference to the following embodiments and the accompanying drawings.
Example (b):
the experimental device consists of an industrial control all-in-one machine, a power interface, a power switch, a charging power supply, a USB interface, an RS232 interface, an RS485/422 interface and a portable case. The connection relation inside the case is shown in fig. 1, and a power supply interface, a power supply switch, a charging power supply and the industrial control all-in-one machine are in power supply connection; the industrial control all-in-one machine is in signal connection with each data interface. When the power switch is turned off, the external power supply can be switched on by the power interface to charge the charging power supply, and when the power switch is switched on, the charging power supply supplies power to the industrial control all-in-one machine, and at the moment, the external power supply is not needed to supply power. The industrial control all-in-one machine receives various experimental parameter settings through the touch screen, realizes signal simulation calculation of the three-axis magnetic sensor, stores and displays experimental results, and simultaneously sends experimental data to the data interface. The USB interface, the RS232 interface and the RS485/422 interface are all data interfaces, and a proper interface can be selected according to the data transmission requirement in use. The components are arranged in a portable case, wherein a power interface, a power switch, a data interface and an industrial control all-in-one machine are arranged on a front panel so as to be convenient to use.
The method for acquiring the simulation correction experiment data of the three-axis magnetic sensor comprises the following steps:
step one, inputting the following parameters through a touch screen of the industrial control integrated machine:
magnetic vector coordinates of reference coordinate system
=[17888, 22986, -16466]In nT;
duration of signal
=20 seconds, sampling interval
=0.01 second;
the attitude and heading angle parameters comprise: course angle vector
=[0 30 60 90 120 150 180 210 240 270 300 330]Vector of pitch angle
=[180 180 180 180 180 180 180 180 180 180 180 180]Transverse roll angle vector
=[10 10 10 10 10 10 10 10 10 10 10 10]All the angle units are degrees;
and measuring error model parameters, including: hard magnetic interference
=[15 29 19]Unit of nT, soft magnetic interference matrix
=[1 0.3 0.1; 0.2 1 0.1; 0.2 0.2 1]Non-aligned matrix
=[0.95 0.22 -0.17; -0.2 0.96 0.13; 0.19 -0.09 0.97]Non-orthogonal matrix
=[0.98 0.1 0.08; 0 0.97 0.05; 0 0 1]Matrix of proportionality coefficients
=[1.2 0 0; 0 0.8 0; 0 0 0.95]Zero offset of sensor
=[20 30 40]In nT, Gaussian white noise variance
=[10000 10000 10000]In the unit of nT
2。
Step two, calculating the magnetic vector coordinates of the carrier coordinate system corresponding to the attitude of the attitude heading reference
The calculation formula is as follows:
in the formula (1), the reaction mixture is,
and
respectively represent
Three parameters corresponding to the attitude of each attitude heading reference: course angle vector, pitch angle vector and roll angle vector. When the course angle vector, the pitch angle vector and the roll angle vector of the 1 st attitude status are 0, 180 and 10 respectively, the magnetic vector coordinate of the carrier coordinate system corresponding to the attitude status can be calculated by the formula (1)
=[14757 -22987 19323]。
Step three, calculating the magnetic vector coordinates of the sensor coordinate system according to the error parameters by the formula (2)
。
In the 1 st attitude of attitude and heading reference
=[3417 -12747 19947]。
Step four, calculating the number of signal sampling points under each attitude of attitude heading reference angle
The specific numerical values are introduced,
will be
Is extended to
Matrix array
Each column of which is arranged as
。
In the 1 st attitude of attitude and heading reference
Is listed as [ 3417-]。
Step five, generating a noise sequence by Gaussian white noise variance
And generating a sensor simulation signal by equation (3)
。
FIG. 2 shows the simulation signal results of the sensor in the 1 st attitude of attitude heading reference.
And step (six), calculating the sensor signal corresponding to each attitude of the attitude heading reference attitude according to the steps (two) to (five), storing and displaying the signal calculation result, and simultaneously sending a simulation signal to the data interface. FIG. 3 is a chart of attitude profiles of attitude of the aircraft.
The above-mentioned embodiments are merely illustrative of the preferred embodiments of the present invention, and do not limit the scope of the present invention, and various modifications and improvements of the technical solution of the present invention by those skilled in the art should fall within the protection scope defined by the claims of the present invention without departing from the spirit of the present invention.