CN112729264A - Arbitrary four-position single gyroscope north-seeking method - Google Patents
Arbitrary four-position single gyroscope north-seeking method Download PDFInfo
- Publication number
- CN112729264A CN112729264A CN202011550057.0A CN202011550057A CN112729264A CN 112729264 A CN112729264 A CN 112729264A CN 202011550057 A CN202011550057 A CN 202011550057A CN 112729264 A CN112729264 A CN 112729264A
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- accelerometer
- sin
- mean value
- output mean
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C17/00—Compasses; Devices for ascertaining true or magnetic north for navigation or surveying purposes
-
- 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/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
The invention discloses a north-seeking method for a single gyroscope at any four positions, which comprises the following steps: installing an inertia device; acquiring static data of a gyroscope and an accelerometer in an inertial device at initial positions; the gyroscope and the accelerometer synchronously rotate for a certain angle to obtain static data of the inertial device at the position; the gyroscope and the accelerometer continuously and synchronously rotate for a certain angle to obtain static data of the inertial device at the position; the gyroscope and the accelerometer synchronously rotate for a certain angle again to obtain static data of the inertial device at the position; and substituting the acquired gyro output mean value and the acquired accelerometer output mean value into a unique azimuth angle solving formula to solve the azimuth angle. The method of the invention has the following effects: the invention can solve the problem that data measurement must be carried out at fixed or symmetrical positions in the traditional four-position scheme because the constraints of the rotating position and the number of sensitive elements are reduced; the invention has the characteristics of convenient operation and strong reliability, and has wide application field.
Description
Technical Field
The invention relates to the technical field of inertia, in particular to a north seeking method for a single gyroscope at any four positions.
Background
The gyro north finder is a high-precision inertial instrument capable of automatically indicating the direction in all weather in a static state, and has wide application prospect in military and civil departments.
The gyro north finder mainly has the function of providing attitude and azimuth reference for a carrier, and most of the current north finders adopt a fiber optic gyro and an accelerometer as main sensitive elements to realize north finding.
In the prior art, the north-seeking scheme based on the transposition has two-position, four-position, multi-position and continuous rotation methods, and the traditional methods have the following defects: part of north-seeking methods require fixed position measurement, such as 90 degrees of rotation orthogonality at four positions, 45 degrees of rotation in psi-type scheme, 90 degrees of included angle between two gyros in two-position scheme and 180 degrees of rotation; the partial north-seeking method has high requirements on constant-speed control of the motor (a continuous rotation method) and has strong conditional constraints.
Therefore, the method which is convenient to operate, few in constraint conditions and high in north-seeking reliability is provided, and the method is of great significance.
Disclosure of Invention
The invention provides a north-seeking method for an arbitrary four-position single gyroscope, which solves the problem that data measurement must be carried out at a fixed or symmetrical position due to the fact that the constraints of the rotating position and the number of sensitive elements are reduced in the traditional four-position scheme, has the characteristics of convenience in operation and high reliability, and can be widely applied to the fields of accurate orientation of weapon systems such as military missile artillery and the like, mine engineering, through measurement and the like which require accurate azimuth reference. The specific technical scheme is as follows:
a single gyro north-seeking method at any four positions comprises the following steps:
the method comprises the following steps of firstly, installing an inertial device, wherein the inertial device comprises a gyroscope and an accelerometer;
second step, acquiring the initial position of a gyroscope and an accelerometer in an inertial deviceStatic data of the initial position to obtain the gyro output mean value omegax 1And accelerometer output mean
Thirdly, synchronously rotating the gyroscope and the accelerometer by an angle mu1Obtaining static data of the gyroscope and the accelerometer in the inertial device at the position to obtain a gyroscope output mean value omegax 2And accelerometer output mean
Step four, synchronizing rotation angles mu of gyroscope and accelerometer2Obtaining static data of the gyroscope and the accelerometer in the inertial device at the position to obtain a gyroscope output mean value omegax 3And accelerometer output mean
Fifthly, synchronously rotating the gyroscope and the accelerometer by an angle mu3Obtaining static data of the gyroscope and the accelerometer in the inertial device at the position to obtain a gyroscope output mean value omegax 4And accelerometer output mean value omegax 4;
And step six, substituting the gyro output mean value and the accelerometer output mean value obtained in the step two to the step five into an expression 1) to solve the azimuth angle alpha:
B=ωnor sin μ1 cosγ;C=ωu[(cos μ1-1)sin θ-sin μ1 cos θ sin γ];
X=ωnor{[cos(μ1+μ2)-cos(μ1+μ2+μ3)]cos θ+[sin(μ1+μ2)-sin(μ1+μ2+μ3)]sin θ sin γ};
Y=-ωnor[sin(μ1+μ2)-sin(μ1+μ2+μ3)]cosγ;
Z=ωu{[cos(μ1+μ2+μ3)-cos(μ1+μ2)]sin θ+(sin(μ1+μ2)-sin(μ1+μ2+μ3))cos θ sin γ};
g is the local earth gravitational acceleration; omegaieIs the rotational angular velocity of the earth;and taking the local latitude.
Preferably, the gyroscope and the accelerometer sensitive shaft are arranged in the same direction, and the shaft is driven to rotate by a motor.
Preferably, the motor drives the shaft to rotate at a constant speed; and the time from the second step to the fifth step is 50-150 seconds when the static data is acquired. And the static data are kept for a period of time, so that enough static data are obtained, and further more accurate gyro output mean value and accelerometer output mean value are obtained.
Preferably, the gyroscope and the accelerometer are both one.
Preferably, said mu1、μ2And mu3Are all 0 DEG to 360 DEG, and preferably mu1、μ2And mu3All are 0 to 90 degrees.
The scheme of the invention has the following effects:
1. according to the invention, north finding can be realized only by one gyroscope and one accelerometer, so that the constraint of the use number of sensitive elements is reduced.
2. According to the invention, the gyroscope and the accelerometer rotate at any angle to obtain the position data of the inertial devices at four positions, and a unique azimuth angle calculation expression is adopted, so that north finding can be accurately realized, the condition constraint on the measured data position in application is greatly reduced, and the operation is convenient; the rotation angle can be selected at will, north finding can be realized in a short time, and the practicability is strong.
Drawings
FIG. 1 is a schematic flow chart of a single gyro north-seeking method at any four positions according to an embodiment of the present invention;
fig. 2 is a schematic diagram of a configuration of north-seeking and indexing of a single gyro at any four positions in the embodiment of the present invention.
Detailed Description
The embodiments of the present invention will be described in detail with reference to the accompanying drawings so that the advantages and features of the invention can be more easily understood by those skilled in the art, and the scope of the invention will be clearly and clearly defined.
Example (b):
a single gyro north-seeking method at any four positions specifically comprises the following steps, which are detailed as shown in figure 1:
the method comprises the following steps that firstly, an inertia device is installed, the inertia device comprises a gyroscope and an accelerometer, only one gyroscope and one accelerometer are needed, a sensitive shaft of the gyroscope and the sensitive shaft of the accelerometer are installed in the same direction, and a motor drives the shafts to rotate; x, Y, Z are shown in FIG. 2, with O being the origin of the coordinates and the gyroscope and accelerometer being mounted on the X-axis.
Secondly, after receiving a north seeking instruction, the motor is locked at the current position P1, stays for a period of time (the initial position data of the gyroscope and the accelerometer in the inertial device is selected for 100 seconds according to requirements of visual conditions, accuracy and the like), and the initial position data of the gyroscope and the accelerometer in the inertial device is obtained to obtain the gyro output mean value omegax 1And accelerometer output mean
Thirdly, controlling the motor to stably drive the gyroscope and the accelerometer to synchronously rotate at an angle mu at a constant speed1The motor is locked at the current position P2, stays for a period of time (the time is selected to be 100 seconds according to requirements of visual working conditions, precision and the like), static data of the gyroscope and the accelerometer in the inertial device at the position are obtained, and the gyro output mean value omega is obtainedx 2And accelerometer output mean
Fourthly, controlling the motor to stably drive the gyroscope, the accelerometer gyroscope and the accelerometer to synchronously rotate at an angle mu at a constant speed2The motor is locked at the current position P3, stays for a period of time (the time is selected to be 100 seconds according to requirements of visual working conditions, precision and the like), static data of the gyroscope and the accelerometer in the inertial device at the position are obtained, and the gyro output mean value omega is obtainedx 3And accelerometer output mean ax 3。
Fifthly, controlling the motor to stably drive the gyroscope and the accelerometer to synchronously rotate at an angle mu at a constant speed3The motor is locked at the current position P4 and stays for a period of time (according to the requirements of visual working conditions, precision and the like)Properly adjusting, selecting 100 seconds here), obtaining static data of the gyroscope and the accelerometer in the inertial device at the position, and obtaining a gyro output mean value omegax 4And accelerometer output mean value omegax 4。
And step six, substituting the gyro output mean value and the accelerometer output mean value obtained in the step two to the step five into an expression 1) to solve the azimuth angle alpha:
B=ωnor sin μ1 cos γ;C=ωu[(cos μ1-1)sin θ-sin μ1 cos θ sin γ];
X=ωnor{[cos(μ1+μ2)-cos(μ1+μ2+μ3)]cos θ+[sin(μ1+μ2)-sin(μ1+μ2+μ3)]sin θ sin γ};
Y=-ωnor[sin(μ1+μ2)-sin(μ1+μ2+μ3)]cosγ;
Z=ωu{[cos(μ1+μ2+μ3)-cos(μ1+μ2)]sin θ+(sin(μ1+μ2)-sin(μ1+μ2+μ3))cos θ sin γ};
g is the local earth gravitational acceleration; omegaieIs the rotational angular velocity of the earth;and taking the local latitude.
The scheme of the present embodiment is simulated (without considering device errors), and details are as follows:
setting simulation initial conditions: see table 1 for details.
According to the input, the output data of the gyroscope and the accelerometer at each position is generated through simulation, and the details are shown in table 1.
TABLE 1 statistics of data under different simulation conditions
As can be seen by combining simulation 1-simulation 5 in the table 1, no matter the data of the initial set azimuth angle is changed (simulation 1 is compared with simulation 4), the set rotation angle is changed (simulation 1, simulation 2 and simulation 3), or the initial values of theta and gamma are changed (simulation 1 is compared with simulation 5), the data of the azimuth angle obtained by the azimuth angle calculation formula of the invention is completely consistent with the setting, and the scheme of the invention can accurately find north at any four positions and has strong practicability.
The above description is only an embodiment of the present invention, and not intended to limit the scope of the present invention, and all modifications of equivalent structures and equivalent processes performed by the present specification and drawings, or directly or indirectly applied to other related technical fields, are included in the scope of the present invention.
Claims (6)
1. A single gyro north-seeking method at any four positions is characterized by comprising the following steps:
the method comprises the following steps of firstly, installing an inertial device, wherein the inertial device comprises a gyroscope and an accelerometer;
secondly, acquiring static data of the gyroscope and the accelerometer in the inertial device at the initial position to obtain a gyroscope output mean value omegax 1And accelerometer output mean
Thirdly, synchronously rotating the gyroscope and the accelerometer by an angle mu1Obtaining static data of the gyroscope and the accelerometer at the position to obtain a gyroscope output mean value omegax 2And accelerometer output mean
Step four, synchronizing rotation angles mu of gyroscope and accelerometer2Obtaining static data of the gyroscope and the accelerometer at the position to obtain a gyroscope output mean value omegax 3And accelerometer output mean
Fifthly, synchronously rotating the gyroscope and the accelerometer by an angle mu3Obtaining static data of the gyroscope and the accelerometer at the position to obtain a gyroscope output mean value omegax 4And addOutput mean value omega of speedometerx 4;
And step six, substituting the gyro output mean value and the accelerometer output mean value obtained in the step two to the step five into an expression 1) to solve the azimuth angle alpha:
A=ωnor[(1-cosμ1)cosθ-sinμ1sinθsinγ];
B=ωnorsinμ1cosγ;C=ωu[(cosμ1-1)sinθ-sinμ1cosθsinγ];
X=ωnor{[cos(μ1+μ2)-cos(μ1+μ2+μ3)]cosθ+[sin(μ1+μ2)-sin(μ1+μ2+μ3)]sinθsinγ};
Y=-ωnor[sin(μ1+μ2)-sin(μ1+μ2+μ3)]cosγ;
Z=ωu{[cos(μ1+μ2+μ3)-cos(μ1+μ2)]sinθ+(sin(μ1+μ2)-sin(μ1+μ2+μ3))cosθsinγ};
2. The north seeking method of any four-position single gyroscope of claim 1 wherein the gyroscope and the accelerometer sensing shaft are mounted in the same direction and the shaft is driven to rotate by a motor.
3. The north seeking method of any four-position single gyroscope of claim 2, wherein the motor drives the shaft to rotate at a constant speed; and the time from the second step to the fifth step is 50-150 seconds when the static data is acquired.
4. The arbitrary four-position single-gyro north-seeking method of claim 2, wherein both the gyroscope and the accelerometer are one.
5. The arbitrary four-position single-gyro north-seeking method according to claim 1, wherein the μ £ is1、μ2And mu3All are 0 to 360 degrees.
6. The arbitrary four-position single-gyro north-seeking method according to claim 5, wherein the μ £ is1、μ2And mu3All are 0 to 90 degrees.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011550057.0A CN112729264B (en) | 2020-12-24 | 2020-12-24 | Arbitrary four-position single gyroscope north-seeking method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011550057.0A CN112729264B (en) | 2020-12-24 | 2020-12-24 | Arbitrary four-position single gyroscope north-seeking method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112729264A true CN112729264A (en) | 2021-04-30 |
CN112729264B CN112729264B (en) | 2021-11-02 |
Family
ID=75605413
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011550057.0A Active CN112729264B (en) | 2020-12-24 | 2020-12-24 | Arbitrary four-position single gyroscope north-seeking method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112729264B (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187558A (en) * | 2007-12-11 | 2008-05-28 | 中国科学院长春光学精密机械与物理研究所 | North seeking device |
CN105115519A (en) * | 2015-08-18 | 2015-12-02 | 北京爱科迪通信技术股份有限公司 | Inertial navigation system initial alignment method applied to satellite-communication-in-motion system |
WO2016126786A1 (en) * | 2015-02-03 | 2016-08-11 | The Regents Of The University Of Michigan | Last-mile navigation using smartphones |
CN109282804A (en) * | 2018-09-01 | 2019-01-29 | 哈尔滨工程大学 | A kind of single axis fiber gyro north-seeking algorithm |
CN109471459A (en) * | 2018-11-08 | 2019-03-15 | 中国船舶重工集团公司第七0七研究所 | A kind of north finder transposition control device and method using step integration PI algorithm |
-
2020
- 2020-12-24 CN CN202011550057.0A patent/CN112729264B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187558A (en) * | 2007-12-11 | 2008-05-28 | 中国科学院长春光学精密机械与物理研究所 | North seeking device |
WO2016126786A1 (en) * | 2015-02-03 | 2016-08-11 | The Regents Of The University Of Michigan | Last-mile navigation using smartphones |
CN105115519A (en) * | 2015-08-18 | 2015-12-02 | 北京爱科迪通信技术股份有限公司 | Inertial navigation system initial alignment method applied to satellite-communication-in-motion system |
CN109282804A (en) * | 2018-09-01 | 2019-01-29 | 哈尔滨工程大学 | A kind of single axis fiber gyro north-seeking algorithm |
CN109471459A (en) * | 2018-11-08 | 2019-03-15 | 中国船舶重工集团公司第七0七研究所 | A kind of north finder transposition control device and method using step integration PI algorithm |
Non-Patent Citations (1)
Title |
---|
薛海建: "《激光陀螺任意二位置寻北仪及误差分析》", 《红外与激光工程》 * |
Also Published As
Publication number | Publication date |
---|---|
CN112729264B (en) | 2021-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103808331B (en) | A kind of MEMS three-axis gyroscope error calibrating method | |
CN112595350B (en) | Automatic calibration method and terminal for inertial navigation system | |
CN108731674B (en) | Inertial astronomical integrated navigation system based on single-axis rotation modulation and calculation method | |
CN109459008B (en) | Small-sized medium-high precision fiber optic gyroscope north seeking device and method | |
US11226203B2 (en) | Low cost INS | |
CN111366144B (en) | Multi-position north-seeking method for gyro north-seeking instrument | |
CN112179340B (en) | Redundant configuration inertia measurement unit double-axis rotation modulation method | |
CN101701824A (en) | High-precision uniaxial rotation attitude measuring system based on laser gyro | |
CN110926447B (en) | Single-axis fiber-optic gyroscope north-seeking method with autonomous navigation function and attitude navigation method | |
SG186362A1 (en) | Improved north finder | |
CN103335643B (en) | A kind of modular optical fiber gyrocompass | |
CN110749338A (en) | Off-axis-rotation composite transposition error calibration method for inertial measurement unit | |
CN104697521A (en) | Method for measuring posture and angle speed of high-speed rotating body by gyro redundant oblique configuration mode | |
CN111486870B (en) | System-level calibration method for inclined strapdown inertial measurement unit | |
CN110501028A (en) | A kind of sixteen bit for dual-axis rotation MEMS-SINS sets rotation modulation method | |
US3039316A (en) | Guidance system utilizing two-axis stabilization | |
CN111551164A (en) | Method for compensating course effect error of rate offset frequency laser gyro north seeker | |
CN103487053A (en) | Strapdown north seeking method for two arbitrary positions | |
CN106248104A (en) | A kind of north finder comprehensive slewing and torque compensation method | |
CN112729264B (en) | Arbitrary four-position single gyroscope north-seeking method | |
CN114994622A (en) | Static boresight method of airborne radar system based on POS | |
CN114707317A (en) | Method and system for measuring flight parameters of spinning projectile based on trajectory prior knowledge | |
US2977806A (en) | Gyroscopic apparatus | |
CN107421564B (en) | A kind of four position north-seeker position shifter error compensation methodes | |
CN113624215A (en) | Mine optical fiber total station and north-seeking method thereof |
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 |