Photoelectric pod gyro drift compensation method based on image field matching

文档序号:697508 发布日期:2021-05-04 浏览:7次 中文

阅读说明:本技术 一种基于图像视场匹配的光电吊舱陀螺漂移补偿的方法 (Photoelectric pod gyro drift compensation method based on image field matching ) 是由 刘玉章 赵志刚 王明才 毛大鹏 于 2019-10-29 设计创作,主要内容包括:本发明涉及一种具有目标捕获功能的光电吊舱自动陀螺漂移补偿的方法。该方法在光电吊舱处于惯性静止状态下,对光学载荷图像内的目标进行捕获,并获得一段时间内的目标移动像元数,包括方位向和俯仰向,继而计算出陀螺方位漂移补偿参数和陀螺俯仰漂移补偿参数进行陀螺漂移补偿。采用本发明提供的陀螺漂移补偿的方法,具有目标捕获功能的光电吊舱能够根据当前光学载荷参数,自动进行陀螺漂移补偿。本发明的光电吊舱陀螺漂移补偿方法可同时补偿光电吊舱的方位和俯仰两个自由度,使光电吊舱的成像设备视轴能够持续、稳定的指向同一方向。(The invention relates to a method for compensating drift of an automatic gyro of a photoelectric pod with a target capturing function. The method includes the steps that when the photoelectric pod is in an inertial static state, a target in an optical load image is captured, the number of target moving pixels in a period of time including the azimuth direction and the pitch direction is obtained, and then a gyro azimuth drift compensation parameter and a gyro pitch drift compensation parameter are calculated to conduct gyro drift compensation. By adopting the gyro drift compensation method provided by the invention, the photoelectric pod with the target capture function can automatically perform gyro drift compensation according to the current optical load parameter. The gyro drift compensation method of the photoelectric pod can simultaneously compensate the azimuth and pitching degrees of freedom of the photoelectric pod, so that the visual axis of the imaging equipment of the photoelectric pod can continuously and stably point to the same direction.)

1. A method for compensating the gyro drift of a photoelectric pod based on image field matching is characterized by comprising the following steps:

step 1: the photoelectric pod works in an inertial static state after being started and self-checked, a target is selected in an optical load image to be captured, and timing is started for a period of time delta t;

step 2: obtaining the pixel number delta x of the direction movement of the captured target in the image and the pixel number delta y of the direction movement of the pitching direction in the delta t time;

and step 3: calculating the azimuth angle A and the pitch angle E of the optical load visual axis drift within the time of delta t according to the pixel number delta x of the captured target moving in the azimuth direction, the pixel number delta y of the captured target moving in the pitch direction, the optical load focal length f and the size l of the imaging detector pixel, wherein the azimuth angle A and the pitch angle E are calculated

And 4, step 4: calculating gyro azimuth drift compensation parameters by using azimuth angle A and pitch angle E of optical load visual axis drift within delta t timeAnd gyro pitch drift compensation parameters

And 5: judging gyro azimuth drift compensation parameter omegaAAnd gyro pitch drift compensation parameter omegaEWhether or not it is greater than the set compensation thresholdIf it is greater than the set compensation thresholdCompensating the parameter omegaAAnd ωEAnd (4) carrying out gyro drift compensation by taking in a gyro sampling program.

2. The method for image field matching based electro-optic pod gyro drift compensation of claim 1, wherein the threshold value is setCalculated according to the allowed maximum field drift angle per second.

3. The method for image field matching based photoelectric pod gyro drift compensation according to claim 1 or 2, wherein the threshold value is setFor optical loads of 1% of the current field of view, i.e.Wherein n is the larger value of the number of pixels in the azimuth and the pitch of the imaging detector.

Technical Field

The invention belongs to the field of automatic control, and particularly relates to a photoelectric pod gyro drift compensation method based on image field matching, which is used for realizing automatic compensation of photoelectric pod gyro drift.

Background

The gyro sensor is one of the core sensors of the electro-optical pod. However, due to the characteristics of the gyro, the gyro has static drift after the photoelectric pod is started, and the drift of the gyro causes the optical visual axis of the photoelectric pod to drift along with the drift, so that the technical index accuracy of the pod is finally influenced. Therefore, the pod needs to compensate for the drift of the gyro. Generally, the compensation of the gyro drift is realized by integrating the output value of the gyro and averaging the integrated value; or the gyro output value is subjected to algorithm compensation by utilizing a combined navigation principle; however, this approach requires the use of GPS or other sensors, thereby increasing equipment costs.

Disclosure of Invention

In view of the above, in order to reduce or even eliminate the influence of the gyro drift on the imaging of the optoelectronic pod, the invention provides a method for compensating the photoelectric pod gyro drift based on image field matching, and aims to realize the automatic compensation of the photoelectric pod gyro drift without adding additional equipment.

In order to solve the technical problem, the invention is realized as follows:

a method for compensating the drift of a photoelectric pod gyro based on image field matching comprises the following steps:

step 1: the photoelectric pod works in an inertial static state after being started and self-checked, a target is selected in an optical load image to be captured, and timing is started for a period of time delta t;

step 2: obtaining the pixel number delta x of the direction movement of the captured target in the image and the pixel number delta y of the direction movement of the pitching direction in the delta t time;

and step 3: calculating the azimuth angle A and the pitch angle E of the optical load visual axis drift within the time of delta t according to the pixel number delta x of the captured target moving in the azimuth direction, the pixel number delta y of the captured target moving in the pitch direction, the optical load focal length f and the size l of the imaging detector pixel, wherein the azimuth angle A and the pitch angle E are calculated

And 4, step 4: calculating gyro azimuth drift compensation parameters by using azimuth angle A and pitch angle E of optical load visual axis drift within delta t timeAnd gyro pitch drift compensation parameters

And 5: judging gyro azimuth drift compensation parameter omegaAAnd gyro pitch drift compensation parameter omegaEWhether or not it is greater than the set compensation thresholdIf it is greater than the set compensation thresholdCompensating the parameter omegaAAnd ωEAnd (4) carrying out gyro drift compensation by taking in a gyro sampling program.

Preferably, the threshold valueCalculated according to the allowed maximum field drift angle per second.

Preferably, the threshold valueFor optical loads of 1% of the current field of view, i.e.Wherein n is the larger value of the number of pixels in the azimuth and the pitch of the imaging detector.

Has the advantages that:

the invention relates to a method for compensating drift of an automatic gyro of a photoelectric pod with a target capturing function. By adopting the gyro drift compensation method provided by the invention, the photoelectric pod with the target capture function can automatically perform gyro drift compensation according to the current optical load parameter. The gyro drift compensation method of the photoelectric pod can simultaneously compensate the azimuth and pitching degrees of freedom of the photoelectric pod, so that the visual axis of the imaging equipment of the photoelectric pod can continuously and stably point to the same direction, additional equipment does not need to be added, and the compensation effect is good.

Drawings

FIG. 1 is a flow chart of the photoelectric pod gyro drift compensation method based on image field matching according to the present invention;

fig. 2 is a schematic diagram of calculation of the optical loading field angle.

Detailed Description

The invention is described in detail below by way of example with reference to the accompanying drawings.

Referring to fig. 1, the present invention provides a method for compensating a gyro drift of a photovoltaic pod based on image field matching, the method comprising:

s101, after the photoelectric pod is started and self-tested, the pod works in an inertial static state, a target is selected in an optical load image to capture, and timing is started for a period of time delta t. The target capture time Δ t is usually 4-6 s. When selecting an object, an object with obvious characteristics is selected. The target with obvious characteristics refers to a target with clear outline, and the target can be judged to be a clear target when the similarity between the target and the background is greater than a set value, wherein the set value can be selected from 30-50%.

And S102, finishing timing, and calculating to obtain the pixel number delta x of the direction movement of the captured target in the image and the pixel number delta y of the pitch direction movement within delta t time. As shown in fig. 2, P and P' are the target positions before and after the movement, respectively.

S103, according to the number of pixels delta x moving in the azimuth direction and the number of pixels delta y moving in the pitch direction of the captured target in the image, and according to the optical load focal length f and the size l of the detector pixels, calculating the azimuth angle A and the pitch angle E of the optical load visual axis drift within the target capture time delta t, wherein the azimuth angle A and the pitch angle E are calculated

104. Calculating gyro azimuth drift compensation parameters according to the azimuth angle A and the pitch angle E of the optical load visual axis drift within the target capture timeAnd gyro pitch drift compensation parameters

S105, judging the gyro azimuth drift compensation parameter omegaAAnd gyro pitch drift compensation parameter omegaEWhether or not it is greater than the set compensation thresholdIf it is greater than the set compensation thresholdCompensating the parameter omegaAAnd ωEAnd (4) carrying out gyro drift compensation by taking in a gyro sampling program. And if the gyro azimuth drift compensation parameter and the gyro pitch drift compensation parameter are not larger than the set compensation threshold, no operation and processing are carried out.

In this step, the threshold is compensatedCalculated according to the allowable maximum field shift angle per second, the maximum field shift angle is 1 percent of the current field angle of the optical load, namelyWherein n is a large value of the number of pixels in the azimuth and pitch of the imaging detector.

In summary, the above description is only a preferred embodiment of the present invention, and is not intended to limit the scope of the present invention. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.

6页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种微机械陀螺的基于自激驱动的非线性控制系统和方法

网友询问留言

已有0条留言

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

精彩留言,会给你点赞!

技术分类