North-seeking error compensation method

文档序号:1488967 发布日期:2020-02-28 浏览:17次 中文

阅读说明:本技术 一种寻北误差补偿方法 (North-seeking error compensation method ) 是由 宋魁 赵政 张君 吴国强 于 2019-11-20 设计创作,主要内容包括:本发明涉及一种寻北误差补偿方法,其特征在于:该方法的步骤为:1)静态位置数据采集;2)沉降角速度转换;3)寻北误差补偿计算。本发明设计科学合理,能有效减小寻北过程中三角架沉降角速度对寻北结果的影响,提高了寻北精度,满足寻北仪在任意场地条件下使用要求,从而提高了寻北仪的环境适应性。(The invention relates to a north-seeking error compensation method, which is characterized by comprising the following steps: the method comprises the following steps: 1) collecting static position data; 2) settling angular velocity conversion; 3) and (5) carrying out north-seeking error compensation calculation. The invention has scientific and reasonable design, can effectively reduce the influence of the tripod sinking angular speed on the north-seeking result in the north-seeking process, improves the north-seeking precision, and meets the use requirement of the north-seeking instrument under any field condition, thereby improving the environmental adaptability of the north-seeking instrument.)

1. A north-seeking error compensation method is characterized in that: the method comprises the following steps:

1) static position data acquisition: the north seeker ISA comprises a gyroscope, an inclinometer and an electronic circuit, and when the north seeker receives a north seeking command, the motor drives the north seeker ISA to rotate to a specified position to acquire data of the gyroscope and the inclinometer within a certain time;

2) and (3) settling angular velocity conversion: according to the gyroscope data and the inclinometer data acquired by the north seeker ISA in the step 1) at the specified position, the settlement angular velocity at the position is calculated, and the calculation formula of the settlement angular velocity is as follows:

wherein: x is the number ofiIs the data acquisition time;

yibeing the sensitive axis Q of inclinometerxData;

ωsis the angular velocity of sedimentation;

3) and (3) north-seeking error compensation calculation: compensating the data of the gyroscope of the north seeker according to the settlement angular velocity calculated in the step 2), solving the true azimuth of the north seeker after settlement compensation,

in multi-position north finding, the model is derived from the gyroscope output

Figure FDA0002280866800000012

Wherein: omegayi-ith position gyroscope data;

αi-ith position angle value data;

ωsi-the sedimentation angular velocity at the ith position;

psi-true azimuth of north seeker;

ωy0-a gyroscope zero bias;

let Y be HX, wherein

Figure FDA0002280866800000013

The least squares method yields:

Figure FDA0002280866800000014

the true azimuth of the north seeker is obtained through calculation by the formula, and the calculation formula is as follows:

Figure FDA0002280866800000021

Technical Field

The invention belongs to the technical field of fiber optic gyroscopes, relates to a gyroscope north seeker, and particularly relates to a north seeking error compensation method.

Background

The gyro north finder is applied to the fields of radars, antennae, military vehicles and the like. By measuring the rotational angular velocity of the earth, the true north direction value of the attached carrier is determined autonomously without being interfered and influenced by an external magnetic field or other environments.

In the use process of the north seeker, a tripod is often used for erecting. But the influences of factors such as temperature, erection field and the like can cause the settlement of the tripod in different degrees, and the settlement angular velocity directly brings the measurement error of the gyroscope, thereby causing the north-seeking error. Therefore, it is necessary to design a north-seeking error compensation method to reduce the influence of tripod settlement on north-seeking accuracy and meet the requirement of high-accuracy north-seeking.

Disclosure of Invention

The invention aims to overcome the defects of the prior art, and provides a north-seeking error compensation method which can effectively reduce the influence of tripod sinking angular velocity on a north-seeking result in the north-seeking process, improve the north-seeking precision, meet the use requirement of a north-seeking instrument under any field condition and further improve the environmental adaptability of the north-seeking instrument.

The technical problem to be solved by the invention is realized by the following technical scheme:

a north-seeking error compensation method is characterized in that: the method comprises the following steps:

1) static position data acquisition: the north seeker ISA comprises a gyroscope, an inclinometer and an electronic circuit, and when the north seeker receives a north seeking command, the motor drives the north seeker ISA to rotate to a specified position to acquire data of the gyroscope and the inclinometer within a certain time;

2) and (3) settling angular velocity conversion: according to the gyroscope data and the inclinometer data acquired by the north seeker ISA in the step 1) at the specified position, the settlement angular velocity at the position is calculated, and the calculation formula of the settlement angular velocity is as follows:

wherein: x is the number ofiIs the data acquisition time;

yibeing the sensitive axis Q of inclinometerxData;

ωsis the angular velocity of sedimentation;

3) and (3) north-seeking error compensation calculation: compensating the data of the gyroscope of the north seeker according to the settlement angular velocity calculated in the step 2), solving the true azimuth of the north seeker after settlement compensation,

in multi-position north finding, the model is derived from the gyroscope output

Figure BDA0002280866810000021

Wherein: omegayi-ith position gyroscope data;

αi-ith position angle value data;

ωsi-the sedimentation angular velocity at the ith position;

psi-true azimuth of north seeker;

ωy0-a gyroscope zero bias;

let Y be HX, wherein

Figure BDA0002280866810000022

The least squares method yields:

Figure BDA0002280866810000023

the true azimuth of the north seeker is obtained through calculation by the formula, and the calculation formula is as follows:

the invention has the advantages and beneficial effects that:

1. the north-seeking error compensation method can effectively reduce the influence of the tripod sinking angular speed on the north-seeking result in the north-seeking process, improves the north-seeking precision, meets the use requirement of the north-seeking instrument under any field condition, and further improves the environmental adaptability of the north-seeking instrument.

Drawings

FIG. 1 is a flow chart of the present invention;

FIG. 2 is a schematic diagram of a north seeker ISA;

FIG. 3 is a schematic diagram of an ISA sensitive sedimentation angular velocity of the north seeker;

FIG. 4 is a diagram of inclinometer data collected during a north seek.

Detailed Description

The present invention is further illustrated by the following specific examples, which are intended to be illustrative, not limiting and are not intended to limit the scope of the invention.

As shown in fig. 1, a north-seeking error compensation method is characterized in that: the method comprises the following steps:

1) static position data acquisition: as shown in fig. 2, the north seeker ISA comprises a gyroscope, an inclinometer and an electronic circuit, and when the north seeker receives a north seeking command, the motor drives the north seeker ISA to rotate to a specified position to acquire data of the gyroscope and the inclinometer within a certain time;

FIG. 3 is a schematic diagram of a coordinate system in which a gyroscope sensitive axis G is located in an orthogonal coordinate system OXYZyCoincident with the OY axis, inclinometer sensitive axis QyCoincident with the OY axis, inclinometer sensitive axis QxCoincident with the OX axis. Due to the influence of factors such as temperature, erection site and the like, the triangular support can be settled in different degrees, so that the sensitive axis G of the gyroscope is causedySuperimposed settling angular velocity ωsBy measuring the sensitive axis Q of the inclinometerxThe change in the inclination angle of the water to calculate the sedimentation angular velocity.

2) And (3) settling angular velocity conversion: according to the gyroscope data and the inclinometer data acquired by the north seeker ISA at the specified position in the step 1), the sinking angular velocity at the position is calculated, fig. 4 shows an example of the inclinometer data acquired during certain north seeking, and the calculation formula of the sinking angular velocity is as follows:

Figure BDA0002280866810000031

wherein: x is the number ofiIs the data acquisition time;

yibeing the sensitive axis Q of inclinometerxData;

ωsis the angular velocity of sedimentation;

3) and (3) north-seeking error compensation calculation: compensating the data of the gyroscope of the north seeker according to the settlement angular velocity calculated in the step 2), solving the true azimuth of the north seeker after settlement compensation,

in multi-position north finding, the model is derived from the gyroscope output

Figure BDA0002280866810000032

Wherein: omegayi-ith position gyroscope data;

αi-ith position angle value data;

ωsi-the sedimentation angular velocity at the ith position;

psi-true azimuth of north seeker;

ωy0-a gyroscope zero bias;

let Y be HX, wherein

Figure BDA0002280866810000041

The least squares method yields:

the true azimuth of the north seeker is obtained through calculation by the formula, and the calculation formula is as follows:

although the embodiments of the present invention and the accompanying drawings are disclosed for illustrative purposes, those skilled in the art will appreciate that: various substitutions, changes and modifications are possible without departing from the spirit and scope of the invention and the appended claims, and therefore the scope of the invention is not limited to the disclosure of the embodiments and the accompanying drawings.

7页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种单激光器的核磁共振陀螺仪

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!

技术分类