CN113432605B - North-seeking method and system based on fiber-optic gyroscope - Google Patents
North-seeking method and system based on fiber-optic gyroscope Download PDFInfo
- Publication number
- CN113432605B CN113432605B CN202110743080.XA CN202110743080A CN113432605B CN 113432605 B CN113432605 B CN 113432605B CN 202110743080 A CN202110743080 A CN 202110743080A CN 113432605 B CN113432605 B CN 113432605B
- Authority
- CN
- China
- Prior art keywords
- fiber
- optic gyroscope
- north
- plane
- angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000005259 measurement Methods 0.000 claims abstract description 65
- 239000013307 optical fiber Substances 0.000 claims description 23
- 239000000835 fiber Substances 0.000 claims description 14
- 238000004891 communication Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 description 5
- 238000013480 data collection Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000010365 information processing Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
Abstract
The invention relates to the technical field of inertial north finding, and provides a north finding method and system based on a fiber-optic gyroscope. The method comprises the following steps: acquiring horizontal inclination angle deviation between a sensitive axis plane of the fiber-optic gyroscope and a horizontal plane; the plane of the sensitive axis is the plane where the sensitive axis of the fiber-optic gyroscope is located; acquiring a first measurement value of the fiber-optic gyroscope when the sensitive shaft points to a first direction in the plane of the sensitive shaft and a second measurement value of the fiber-optic gyroscope when the sensitive shaft points to a second direction in the plane of the sensitive shaft; wherein the first direction and the second direction differ by 180 degrees; a true north direction is determined based on the first measurement, the second measurement, and the horizontal tilt deviation. The invention can eliminate the measurement precision error of the fiber-optic gyroscope and improve the accuracy of the north-seeking result.
Description
Technical Field
The invention relates to the technical field of inertial north finding, in particular to a north finding method and system based on a fiber-optic gyroscope.
Background
The fiber-optic gyroscope north-seeking system can measure the north azimuth angle, has the characteristics of long service life, simple structure and the like, and is widely applied to individual soldier field special combat to carry out target positioning and navigation.
However, the measurement precision of the fiber optic gyroscope is greatly influenced by temperature, and in actual measurement, because the fiber optic gyroscope cannot be completely horizontally placed, the measurement precision is further reduced, and the accuracy of a north-seeking result is greatly reduced.
Disclosure of Invention
The embodiment of the invention provides a north-seeking method and a north-seeking system based on a fiber-optic gyroscope, which are used for eliminating the measurement precision error of the fiber-optic gyroscope and improving the accuracy of a north-seeking result.
In a first aspect, an embodiment of the present invention provides a north-seeking method based on a fiber-optic gyroscope, including:
acquiring horizontal inclination angle deviation between a sensitive axis plane of the fiber-optic gyroscope and a horizontal plane; wherein, the sensitive axis plane is the rotation plane of the sensitive axis of the fiber-optic gyroscope;
acquiring a first measurement value of the fiber-optic gyroscope when the sensitive shaft points to a first direction in the plane of the sensitive shaft and a second measurement value of the fiber-optic gyroscope when the sensitive shaft points to a second direction in the plane of the sensitive shaft; wherein the first direction and the second direction differ by 180 degrees;
a true north direction is determined based on the first measurement, the second measurement, and the horizontal tilt deviation.
In one possible implementation, determining the true north direction from the first measurement, the second measurement, and the horizontal tilt deviation includes:
calculating an included angle between the first direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the first direction and the due north direction;
the formula for calculating the included angle between the first direction and the due north direction is as follows:
in the formula, theta 1 Is the angle between the first direction and the true north direction, ω fA Is a first measured value, ω fB Is a second measured value, K ε As a calibration factor, omega, of a fibre-optic gyroscope e Is the angular velocity of the earth's rotation,
and theta is the latitude value of the current position of the optical fiber gyroscope, and theta is the horizontal inclination deviation.
In one possible implementation, determining a true north direction from the first measurement, the second measurement, and the horizontal tilt deviation includes:
calculating an included angle between the second direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the second direction and the due north direction;
the formula for calculating the included angle between the second direction and the due north direction is as follows:
in the formula, theta 2 Is the angle between the second direction and the north direction, omega fA Is a first measured value, ω fB Is a second measured value, K ε As a calibration factor, omega, of a fibre-optic gyroscope e Is the angular velocity of the earth's rotation,
and theta is the latitude value of the current position of the optical fiber gyroscope, and theta is the horizontal inclination deviation.
In one possible implementation, the first direction is a pre-estimated east-ward direction or west-ward direction;
the method further comprises the following steps:
acquiring a pre-estimated east-oriented direction, taking the pre-estimated east-oriented direction as a first direction, and determining a second direction according to the first direction;
or, a pre-estimated western direction is obtained, the pre-estimated western direction is taken as a first direction, and a second direction is determined according to the first direction.
In a possible implementation manner, after acquiring a horizontal inclination angle deviation between a sensitive axis plane of the fiber optic gyroscope and a horizontal plane, the method further includes:
judging whether the horizontal inclination deviation is smaller than a preset threshold value or not;
if the horizontal inclination deviation is not less than the preset threshold, adjusting an included angle between a rotating shaft of the fiber-optic gyroscope and the horizontal plane, and obtaining the horizontal inclination deviation between the sensitive shaft plane of the fiber-optic gyroscope and the horizontal plane again until the horizontal inclination deviation is less than the preset threshold.
In a second aspect, an embodiment of the present invention provides a fiber-optic gyroscope-based north-seeking system, which is configured to implement the fiber-optic gyroscope-based north-seeking method in the first aspect or any possible implementation manner of the first aspect, and the system includes:
the device comprises an acquisition module and an upper computer, wherein the acquisition module comprises a fiber-optic gyroscope and an electronic inclinometer;
the electronic inclinometer is used for measuring the horizontal inclination angle deviation between the sensitive axis plane of the fiber optic gyroscope and the horizontal plane and sending the horizontal inclination angle deviation to the upper computer; wherein, the sensitive axis plane is the rotation plane of the sensitive axis of the fiber-optic gyroscope;
the fiber optic gyroscope is used for sending a first measured value to the upper computer when the sensitive axis points to a first direction in the plane of the sensitive axis and sending a second measured value to the upper computer when the sensitive axis points to a second direction in the plane of the sensitive axis; wherein the first direction and the second direction differ by 180 degrees;
the upper computer is used for determining the true north direction according to the first measurement value, the second measurement value and the horizontal inclination deviation.
In one possible implementation manner, the acquisition module further includes:
a turntable;
the optical fiber gyroscope is fixed on the rotary table, and the upper computer is also used for controlling the rotary table to rotate so that the sensitive axis of the optical fiber gyroscope points to a first direction or a second direction in the plane of the sensitive axis.
In one possible implementation manner, the acquisition module further includes:
an electronic compass;
the electronic compass is used for estimating the east-righting direction and sending the azimuth angle of the east-righting direction to the upper computer, the upper computer determines a first direction and a second direction according to the azimuth angle of the east-righting direction and controls the rotary table to rotate so that the sensitive axis of the fiber-optic gyroscope points to the first direction or the second direction;
or the electronic compass is used for estimating the westernness direction and sending the azimuth angle of the westernness direction to the upper computer, the upper computer determines the first direction and the second direction according to the azimuth angle of the westernness direction and controls the rotary table to rotate so that the sensitive axis of the fiber-optic gyroscope points to the first direction or the second direction.
In one possible implementation, the system further includes:
a communication module;
the acquisition module sends the first measurement value, the second measurement value and the horizontal inclination deviation to the upper computer through the communication module, and the acquisition module sends the azimuth angle in the east-right direction or the azimuth angle in the west-right direction to the upper computer through the communication module.
In one possible implementation, the system further includes:
a power converter;
the power supply converter is used for converting externally input current into direct current with a preset size and transmitting the direct current with the preset size to the acquisition module so as to supply power to the acquisition module.
Compared with the prior art, the embodiment of the invention has the following beneficial effects:
the embodiment of the invention adopts a two-position north-seeking mode, namely, the north-seeking direction is determined by combining a first measurement value of the fiber-optic gyroscope when the sensitive shaft points to a first direction in the plane of the sensitive shaft and a second measurement value of the fiber-optic gyroscope when the sensitive shaft points to a second direction in the plane of the sensitive shaft, so that the measurement precision error caused by the influence of temperature on the fiber-optic gyroscope can be eliminated in the calculation process; furthermore, the horizontal inclination deviation between the plane of the sensitive axis of the fiber-optic gyroscope and the horizontal plane is introduced into the calculation process, and the error generated by the incomplete horizontal placement of the fiber-optic gyroscope is corrected. The invention can improve the accuracy of the north-seeking result.
Drawings
In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings needed to be used in the embodiments or the prior art descriptions will be briefly described below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings based on these drawings without inventive exercise.
Fig. 1 is a flowchart of an implementation of a north-seeking method based on a fiber optic gyroscope according to an embodiment of the present invention;
FIG. 2 is a measurement schematic diagram of a north-seeking method based on a fiber-optic gyroscope according to an embodiment of the present invention;
fig. 3 is a schematic structural diagram of a north-seeking system based on a fiber-optic gyroscope according to an embodiment of the present invention.
Detailed Description
In the following description, for purposes of explanation and not limitation, specific details are set forth, such as particular system structures, techniques, etc. in order to provide a thorough understanding of the embodiments of the invention. It will be apparent, however, to one skilled in the art that the present invention may be practiced in other embodiments that depart from these specific details. In other instances, detailed descriptions of well-known systems, devices, circuits, and methods are omitted so as not to obscure the description of the present invention with unnecessary detail.
In order to make the objects, technical solutions and advantages of the present invention more apparent, the following description is made by way of specific embodiments with reference to the accompanying drawings.
Referring to fig. 1, it shows a flowchart of an implementation of the north-seeking method based on the fiber-optic gyroscope according to the embodiment of the present invention, which is detailed as follows:
s101, acquiring horizontal inclination deviation between a sensitive axis plane of the fiber optic gyroscope and a horizontal plane; the sensitive axis plane is a rotation plane of the sensitive axis of the fiber-optic gyroscope.
In the embodiment of the invention, the optical fiber gyroscope is placed on a rotating mechanism such as a turntable and the like, the rotating mechanism drives the optical fiber gyroscope to rotate, and the rotating plane of the sensitive shaft of the optical fiber gyroscope is vertical to the rotating shaft of the rotating mechanism. Under the ideal measurement condition, the fiber-optic gyroscope is ensured to be completely horizontally placed, namely the plane of the sensitive axis of the fiber-optic gyroscope is parallel to the horizontal plane. However, in the actual measurement process, the fiber-optic gyroscope cannot be strictly kept horizontal, and a certain horizontal inclination angle deviation exists between the plane of the sensitive axis of the fiber-optic gyroscope and the horizontal plane.
S102, acquiring a first measurement value of the fiber-optic gyroscope when the sensitive shaft points to a first direction in the plane of the sensitive shaft and a second measurement value of the fiber-optic gyroscope when the sensitive shaft points to a second direction in the plane of the sensitive shaft; wherein the first direction and the second direction differ by 180 degrees.
In the embodiment of the present invention, the first direction may be any direction in the plane of the sensitive axis, and the second direction is the first direction rotated by 180 degrees in the forward direction or the reverse direction. The sensing axis of the fiber-optic gyroscope is measured to obtain a first measured value when pointing to the first direction, and the sensing axis of the fiber-optic gyroscope is measured to obtain a second measured value when pointing to the second direction, so that the north-seeking mode of the two positions is realized.
And S103, determining the true north direction according to the first measurement value, the second measurement value and the horizontal inclination deviation.
Therefore, the embodiment of the invention adopts a two-position north-seeking mode, namely, the north-seeking direction is determined by combining a first measurement value of the fiber-optic gyroscope when the sensitive shaft points to the first direction in the sensitive shaft plane and a second measurement value of the fiber-optic gyroscope when the sensitive shaft points to the second direction in the sensitive shaft plane, so that the measurement precision error caused by the influence of the temperature on the fiber-optic gyroscope can be eliminated in the calculation process; furthermore, the horizontal inclination angle deviation between the sensitive axis plane of the fiber-optic gyroscope and the horizontal plane is introduced into the calculation process, and the error generated by the incomplete horizontal placement of the fiber-optic gyroscope is corrected. The invention can improve the accuracy of the north-seeking result.
Optionally, in a possible implementation, the north direction is determined according to the first measurement value, the second measurement value and the horizontal inclination deviation, which may be detailed as:
calculating an included angle between the first direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the first direction and the due north direction;
the formula for calculating the included angle between the first direction and the due north direction is as follows:
in the formula, theta 1 Is the angle between the first direction and the true north direction, ω fA As a first measured value, ω fB Is a second measured value, K ε As a calibration factor, omega, of a fibre-optic gyroscope e Is the angular velocity of the earth's rotation,
and theta is the latitude value of the current position of the optical fiber gyroscope, and theta is the horizontal inclination deviation.
Optionally, in a possible implementation, the north direction is determined according to the first measurement value, the second measurement value and the horizontal inclination deviation, which may be detailed as:
calculating an included angle between the second direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the second direction and the due north direction;
the formula for calculating the included angle between the second direction and the due north direction is as follows:
in the formula, theta 2 Is the angle between the second direction and the north direction, omega fA Is a first measured value, ω fB Is a second measured value, K ε As a calibration factor, omega, of a fibre-optic gyroscope e Is the angular velocity of the earth's rotation,
and theta is the latitude value of the current position of the optical fiber gyroscope, and theta is the horizontal inclination deviation.
In the embodiment of the present invention, the north-seeking principle is explained with reference to fig. 2.
The optical fiber gyroscope is positioned on a rotary table and can rotate along with the rotary table so as to adjust the direction of a sensitive shaft of the optical fiber gyroscope. Ideally, the rotating shaft of the fiber-optic gyroscope is perpendicular to the horizontal plane, and the plane of the sensitive axis of the fiber-optic gyroscope is parallel to the horizontal plane. When the optical fiber gyroscope stays at any position of 0-360 degrees of the rotary table, the optical fiber gyroscope can measure the horizontal component omega of the earth angular rate in all directions e1 The measurement is a sinusoidal signal, where the zero values correspond to the true east and the true west, the peaks correspond to the true south and north, ω e The rotation speed of the earth is used as the rotation speed of the earth,
the latitude of the earth.
Under the condition of not considering the error of the device, if the included angle between the sensitive axis of the fiber-optic gyroscope and the due north direction is theta, the output value of the fiber-optic gyroscope is as follows:
further, derived to
Because the fiber-optic gyroscope has zero offset, calibration factor offset and random error, the actual output value of the fiber-optic gyroscope is as follows:
wherein the random error epsilon 0 Suppression can be achieved by filtering and lengthening the sampling time, but ultimately depends on gyro accuracy, but is limited by a scaling factor K ε The error caused by the temperature is small and can be ensured by the precision of a control device, so that the zero offset omega of the fiber-optic gyroscope caused by the temperature 0 The greatest impact on accuracy. By calculating through the two-position method, the zero offset omega can be eliminated 0 The effect of (a) is as follows:
an included angle between a first direction pointed by a sensitive axis of the fiber-optic gyroscope and the due north direction is set to be theta 1 Then, then
It can be seen from the formula that the zero offset omega is directly eliminated by subtracting the measured values of the fiber-optic gyroscope in two directions 0 The influence of (c).
Further, considering that the fiber-optic gyroscope is not completely horizontally placed during measurement, assuming that the inclination angle between the plane of the sensitive axis of the fiber-optic gyroscope and the horizontal plane is α, the gyroscope output value can be described as follows:
to obtain
Optionally, in a possible implementation, the first direction is a pre-estimated east-right direction or west-right direction. The method further comprises the following steps:
acquiring a pre-estimated east-oriented direction, taking the pre-estimated east-oriented direction as a first direction, and determining a second direction according to the first direction;
or, a pre-estimated western direction is obtained, the pre-estimated western direction is taken as a first direction, and a second direction is determined according to the first direction.
In the embodiment of the invention, the horizontal component of the rotational angular velocity of the earth in the east-west direction is considered to be minimum, so that the north seeking calculation is carried out through the measurement value in the east-west direction, and the precision can be further improved. East-west directions can be roughly measured by a measuring device, including but not limited to an electronic compass or the like.
Optionally, in a possible implementation manner, after acquiring a horizontal inclination deviation between a sensitive axis plane of the fiber optic gyroscope and a horizontal plane, the method further includes:
judging whether the deviation of the horizontal inclination angle is smaller than a preset threshold value or not;
if the horizontal inclination deviation is not less than the preset threshold, adjusting an included angle between a rotating shaft of the fiber-optic gyroscope and the horizontal plane, and obtaining the horizontal inclination deviation between the sensitive shaft plane of the fiber-optic gyroscope and the horizontal plane again until the horizontal inclination deviation is less than the preset threshold.
In the embodiment of the invention, in order to ensure the north-seeking precision, the fiber-optic gyroscope should be placed horizontally as much as possible, that is, the deviation of the horizontal inclination angle is as close to zero as possible, and the typical value of the preset threshold is set to be 1.
It should be understood that, the sequence numbers of the steps in the foregoing embodiments do not imply an execution sequence, and the execution sequence of each process should be determined by its function and inherent logic, and should not constitute any limitation to the implementation process of the embodiments of the present invention.
An embodiment of the present invention provides a north-seeking system based on a fiber-optic gyroscope, where the north-seeking system is configured to implement the method in any of the above embodiments, and as shown in fig. 3, the north-seeking system includes:
the device comprises an acquisition module and an upper computer, wherein the acquisition module comprises a fiber-optic gyroscope (a fiber-optic gyroscope inertia sensitive part and an information processing unit) and an electronic inclinometer. The electronic inclinometer is used for measuring the horizontal inclination deviation between the plane of the sensitive shaft of the fiber optic gyroscope and the horizontal plane and sending the horizontal inclination deviation to the upper computer; the sensitive axis plane is a rotation plane of the sensitive axis of the fiber-optic gyroscope. The fiber optic gyroscope is used for sending a first measured value to the upper computer when the sensitive axis points to a first direction in the plane of the sensitive axis and sending a second measured value to the upper computer when the sensitive axis points to a second direction in the plane of the sensitive axis; wherein the first direction and the second direction differ by 180 degrees. The upper computer is used for determining the true north direction according to the first measurement value, the second measurement value and the horizontal inclination deviation.
In the embodiment of the invention, the fiber-optic gyroscope inertia sensitive component realizes the measurement of the earth rotation speed. The information processing unit completes data rich collection and signal processing of the fiber-optic gyroscope and outputs a measured value.
Optionally, in a possible implementation manner, the acquisition module further includes
A turntable.
The optical fiber gyroscope is fixed on the rotary table, and the upper computer is also used for controlling the rotary table to rotate so that the sensitive axis of the optical fiber gyroscope points to a first direction or a second direction in the plane of the sensitive axis.
Optionally, in a possible implementation manner, the acquisition module further includes:
an electronic compass.
The electronic compass is used for estimating the east-righting direction and sending the azimuth angle of the east-righting direction to the upper computer, the upper computer determines the first direction and the second direction according to the azimuth angle of the east-righting direction, and controls the rotary table to rotate so that the sensitive axis of the fiber-optic gyroscope points to the first direction or the second direction.
Or the electronic compass is used for estimating the westernness direction and sending the azimuth angle of the westernness direction to the upper computer, the upper computer determines the first direction and the second direction according to the azimuth angle of the westernness direction and controls the rotary table to rotate so that the sensitive axis of the fiber-optic gyroscope points to the first direction or the second direction.
In the embodiment of the invention, the electronic compass carries out rough measurement of the direction, is an integrated three-axis fluxgate sensor, adopts a hard magnetic and soft magnetic calibration algorithm, and solves the course angle in real time through a CPU (Central processing Unit), so that the electronic compass can achieve higher precision in an environment with magnetic field interference.
Optionally, in a possible implementation manner, the system further includes:
and a communication module.
The acquisition module sends the first measurement value, the second measurement value and the horizontal inclination deviation to the upper computer through the communication module, and the acquisition module sends the azimuth angle in the east-right direction or the azimuth angle in the west-right direction to the upper computer through the communication module.
In the embodiment of the present invention, the communication module may be an RS422 communication interface.
Optionally, in a possible implementation manner, the system further includes:
a power converter.
The power supply converter is used for converting externally input current into direct current with a preset size and transmitting the direct current with the preset size to the acquisition module so as to supply power to the acquisition module.
In the embodiment of the invention, the power supply converter converts the 28V direct current provided by the outside into the direct current of +/-5V so as to meet the power consumption requirement of the acquisition module.
Illustratively, the specific measurement steps of the system may be as follows:
(1) The measuring personnel writes the local latitude value into an upper computer;
(2) Adjusting the level of the fiber optic gyroscope, ensuring that the deviation of the horizontal inclination angle is less than 1 degree, and simultaneously sending a measurement result to an upper computer by the electronic inclinometer;
(3) Roughly measuring by using an electronic compass for about 10S, estimating to obtain the east-righting direction, and sending the azimuth angle of the east-righting direction to an upper computer;
(4) The upper computer controls a sensitive axis of the fiber-optic gyroscope to point to the east-righting direction through the turntable, starts to statically collect data for 120s, and sends the data to the upper computer through the communication interface after the data collection is finished;
(5) The upper computer controls the sensitive shaft of the fiber-optic gyroscope to accurately rotate 180 degrees through the turntable, statically collects data for 120s, and sends the data to the upper computer through the communication interface after the data collection is finished;
(6) And the upper computer accurately determines the north direction according to the measurement data.
The above-mentioned embodiments are only used to illustrate the technical solution of the present invention, and not to limit the same; although the present invention has been described in detail with reference to the foregoing embodiments, it should be understood by those of ordinary skill in the art that: the technical solutions described in the foregoing embodiments may still be modified, or some technical features may be equivalently replaced; such modifications and substitutions do not substantially depart from the spirit and scope of the embodiments of the present invention, and are intended to be included within the scope of the present invention.
Claims (5)
1. A north-seeking method based on a fiber-optic gyroscope is characterized by comprising the following steps:
acquiring horizontal inclination deviation between a sensitive axis plane of the fiber optic gyroscope and a horizontal plane; wherein the sensitive axis plane is a rotation plane of the sensitive axis of the fiber-optic gyroscope;
acquiring a first measurement value of the fiber-optic gyroscope when the sensitive shaft points to a first direction in a sensitive shaft plane and a second measurement value of the fiber-optic gyroscope when the sensitive shaft points to a second direction in the sensitive shaft plane; wherein the first direction and the second direction differ by 180 degrees;
determining a true north direction from the first measurement, the second measurement, and the horizontal tilt deviation;
the first direction is a pre-estimated east-oriented direction or west-oriented direction;
the first direction is obtained by rough measurement of an electronic compass;
the method further comprises the following steps:
acquiring a pre-estimated east alignment direction, taking the pre-estimated east alignment direction as a first direction, and determining a second direction according to the first direction;
or acquiring a pre-estimated western direction, taking the pre-estimated western direction as a first direction, and determining a second direction according to the first direction;
determining a true north direction from the first measurement, the second measurement, and the horizontal tilt deviation, comprising:
calculating an included angle between the first direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the first direction and the due north direction; the formula for calculating the included angle between the first direction and the due north direction is as follows:
in the formula, theta 1 Is the angle between the first direction and the north direction, omega fA Is said first measured value, ω fB Is said second measured value, K ε Is a calibration factor, omega, of the fiber-optic gyroscope e For the speed of the rotation angle of the earth, is>
The latitude value of the current position of the optical fiber gyroscope is obtained, and theta is the horizontal inclination deviation;
or calculating the included angle between the second direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviationDetermining the due north direction based on an included angle between the second direction and the due north direction; the formula for calculating the included angle between the second direction and the due north direction is as follows:
in the formula, theta 2 Is the angle between the second direction and the north direction, omega fA Is said first measured value, ω fB Is said second measured value, K ε Is a calibration factor, omega, of the fiber-optic gyroscope e For the speed of the rotation angle of the earth, is>
And theta is the latitude value of the current position of the optical fiber gyroscope, and theta is the horizontal inclination deviation.
2. The fiber-optic gyroscope-based north-seeking method according to claim 1, further comprising, after obtaining a horizontal tilt angle deviation between a sensitive axis plane of the fiber-optic gyroscope and a horizontal plane:
judging whether the deviation of the horizontal inclination angle is smaller than a preset threshold value or not;
if the horizontal inclination angle deviation is not smaller than the preset threshold value, adjusting an included angle between a rotating shaft of the optical fiber gyroscope and the horizontal plane, and obtaining the horizontal inclination angle deviation between the sensitive shaft plane of the optical fiber gyroscope and the horizontal plane again until the horizontal inclination angle deviation is smaller than the preset threshold value.
3. A north-seeking system based on a fiber-optic gyroscope, which is used for implementing the north-seeking method based on the fiber-optic gyroscope of claim 1 or 2, and comprises:
the device comprises an acquisition module and an upper computer, wherein the acquisition module comprises a fiber-optic gyroscope and an electronic inclinometer;
the electronic inclinometer is used for measuring the horizontal inclination deviation between the plane of the sensitive shaft of the fiber optic gyroscope and the horizontal plane and sending the horizontal inclination deviation to the upper computer; wherein the sensitive axis plane is a rotation plane of the sensitive axis of the fiber-optic gyroscope;
the optical fiber gyroscope is used for sending a first measurement value to the upper computer when the sensitive axis points to a first direction in the sensitive axis plane and sending a second measurement value to the upper computer when the sensitive axis points to a second direction in the sensitive axis plane; wherein the first direction and the second direction differ by 180 degrees;
the upper computer is used for determining the true north direction according to the first measurement value, the second measurement value and the horizontal inclination deviation;
wherein determining a true north direction from the first measurement, the second measurement, and the horizontal tilt deviation comprises:
calculating an included angle between the first direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the first direction and the due north direction; the formula for calculating the included angle between the first direction and the due north direction is as follows:
in the formula, theta 1 Is the angle between the first direction and the true north direction, ω fA Is said first measured value, ω fB Is said second measured value, K ε Is a calibration factor, omega, of the fiber-optic gyroscope e For the speed of rotation of the earth>
The latitude value of the current position of the optical fiber gyroscope is obtained, and theta is the horizontal inclination deviation;
or calculating an included angle between the second direction and the due north direction according to the first measured value, the second measured value and the horizontal inclination deviation, and determining the due north direction based on the included angle between the second direction and the due north direction; the formula for calculating the included angle between the second direction and the due north direction is as follows:
in the formula, theta 2 Is the angle between the second direction and the north direction, omega fA Is said first measured value, ω fB Is said second measured value, K ε Is a calibration factor, omega, of the fiber-optic gyroscope e For the speed of the rotation angle of the earth, is>
The latitude value of the current position of the optical fiber gyroscope is obtained, and theta is the horizontal inclination deviation;
the acquisition module further comprises:
the electronic compass and the rotary table are fixed on the optical fiber gyroscope;
the electronic compass is used for estimating an east-oriented direction, sending an azimuth angle of the east-oriented direction to the upper computer, determining a first direction and a second direction according to the azimuth angle of the east-oriented direction by the upper computer, and controlling the rotary table to rotate so that a sensitive axis of the fiber-optic gyroscope points to the first direction or the second direction;
or the electronic compass is used for estimating the western direction and sending the azimuth angle of the western direction to the upper computer, and the upper computer determines a first direction and a second direction according to the azimuth angle of the western direction and controls the turntable to rotate so that the sensitive axis of the fiber-optic gyroscope points to the first direction or the second direction.
4. The fiber-optic gyroscope-based north-seeking system according to claim 3, further comprising:
a communication module;
the acquisition module sends the first measurement value, the second measurement value and the horizontal inclination deviation to the upper computer through the communication module, and the acquisition module sends the azimuth angle in the east-oriented direction or the azimuth angle in the west-oriented direction to the upper computer through the communication module.
5. The fiber optic gyroscope-based north seeking system according to any one of claims 3-4, further comprising:
a power converter;
the power converter is used for converting externally input current into direct current with a preset size and transmitting the direct current with the preset size to the acquisition module so as to supply power to the acquisition module.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110743080.XA CN113432605B (en) | 2021-06-30 | 2021-06-30 | North-seeking method and system based on fiber-optic gyroscope |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110743080.XA CN113432605B (en) | 2021-06-30 | 2021-06-30 | North-seeking method and system based on fiber-optic gyroscope |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113432605A CN113432605A (en) | 2021-09-24 |
| CN113432605B true CN113432605B (en) | 2023-03-31 |
Family
ID=77758510
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110743080.XA Active CN113432605B (en) | 2021-06-30 | 2021-06-30 | North-seeking method and system based on fiber-optic gyroscope |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113432605B (en) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101216313A (en) * | 2007-12-27 | 2008-07-09 | 浙江大学 | Multi-location north seeking method based on optical fibre gyroscope |
| US8521428B1 (en) * | 2009-10-15 | 2013-08-27 | Moog Inc. | Heading determination using sensors mounted on rotatable assembly |
Family Cites Families (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7801704B2 (en) * | 2008-05-15 | 2010-09-21 | Schlumberger Technology Corporation | Method and system for azimuth measurements using gyro sensors |
| CN101907460B (en) * | 2010-02-10 | 2012-06-06 | 南京航空航天大学 | Particle filtering method for north-seeking of fiber optic gyroscope |
| CN102735231B (en) * | 2012-06-21 | 2014-12-10 | 浙江大学 | Method for improving precision of fiber optic gyroscope (FOG) north-seeker |
| CN102749477B (en) * | 2012-07-11 | 2014-04-16 | 浙江大学 | Method for measuring angular deviation between surface and rotating shaft of turntable by utilizing fiber-optic gyroscope |
| CN103743413B (en) * | 2013-12-27 | 2016-05-04 | 哈尔滨工程大学 | Heeling condition modulated is sought northern instrument alignment error On-line Estimation and is sought northern error compensating method |
| CN108168516B (en) * | 2017-12-13 | 2020-07-03 | 陕西宝成航空仪表有限责任公司 | Method for measuring inclined included angle between to-be-measured table top and reference horizontal plane based on fiber-optic gyroscope |
| CN109282804B (en) * | 2018-09-01 | 2021-11-09 | 哈尔滨工程大学 | Single-axis fiber-optic gyroscope north-seeking algorithm |
| CN111504288B (en) * | 2020-04-22 | 2021-10-08 | 北京港震科技股份有限公司 | North seeking device |
-
2021
- 2021-06-30 CN CN202110743080.XA patent/CN113432605B/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101216313A (en) * | 2007-12-27 | 2008-07-09 | 浙江大学 | Multi-location north seeking method based on optical fibre gyroscope |
| US8521428B1 (en) * | 2009-10-15 | 2013-08-27 | Moog Inc. | Heading determination using sensors mounted on rotatable assembly |
Non-Patent Citations (1)
| Title |
|---|
| Juliang Cao，等.Research on North-Seeking Based on Dual FOGs and Virtual Inertial Instruments .Proceedings of the 2008 IEEE International Conference on Information and Automation .2018,全文. * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113432605A (en) | 2021-09-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102207386A (en) | North-finding method based on orientation effect error compensation | |
| CN111366144B (en) | Multi-position north-seeking method for gyro north-seeking instrument | |
| US11226203B2 (en) | Low cost INS | |
| CN102257358A (en) | Method for determining a heading in the direction of true north using an inertial measurement unit | |
| CN110926447B (en) | Single-axis fiber-optic gyroscope north-seeking method with autonomous navigation function and attitude navigation method | |
| CN100575876C (en) | Gyroscopic compass multiple positions self-determination orienting north finding device | |
| CN109459008A (en) | The small-sized middle high-precision optical fiber gyro north finding device of one kind and method | |
| CN111829503B (en) | Method and device for testing threshold value of fiber-optic gyroscope | |
| CN111765880B (en) | High-precision four-position north-seeking method based on single fiber gyroscope | |
| CN114111753A (en) | Fiber-optic gyroscope north seeker | |
| CN101082491A (en) | Pendulum type gyroscope north searching instrument measurement method | |
| Zhao et al. | Magnetometer-based phase shifting ratio method for high spinning projectile’s attitude measurement | |
| CN214951273U (en) | Position indicating system | |
| CN113432605B (en) | North-seeking method and system based on fiber-optic gyroscope | |
| CN106248104A (en) | A kind of north finder comprehensive slewing and torque compensation method | |
| CN111895968B (en) | High-precision composite horizontal angle measuring system | |
| CN111609869A (en) | Positive and negative multi-position fiber-optic gyroscope orientation effect judgment method based on hypothesis testing | |
| JP2000249552A (en) | Method and device for searching north | |
| CN109470275A (en) | High-precision autonomous orientation method for photoelectric theodolite of motorized station distribution | |
| CN104697487B (en) | A kind of plane normal azimuth measuring method and its application | |
| CN216483089U (en) | Fiber-optic gyroscope north seeker | |
| CN115773750B (en) | Magnetic course angle measuring device and method | |
| CN113137964B (en) | Airborne astronomical navigation method and device and electronic equipment | |
| JP2609976B2 (en) | Compass | |
| CN112781577B (en) | Novel inclinometer north-seeking calculation method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |