CN113418523B - 用于机载光电观瞄***目标可靠跟踪的速度补偿方法 - Google Patents
用于机载光电观瞄***目标可靠跟踪的速度补偿方法 Download PDFInfo
- Publication number
- CN113418523B CN113418523B CN202110673639.6A CN202110673639A CN113418523B CN 113418523 B CN113418523 B CN 113418523B CN 202110673639 A CN202110673639 A CN 202110673639A CN 113418523 B CN113418523 B CN 113418523B
- Authority
- CN
- China
- Prior art keywords
- target
- north
- ins
- east
- speed
- 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
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明属于机载光电侦察技术领域,具体涉及一种用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其基于载机的姿态角度、矢量速度、海拔高度和光电***瞄准线的方位/俯仰角度,光电***在跟踪模式下实时解算目标在‘大地东‑北‑天坐标系’的速度,在记忆跟踪模式下实时解算目标在‘光电***当前瞄准线指向坐标系’下的方位/俯仰角速度,并使用该角速度值进行伺服补偿,使瞄准线指向被遮挡目标,实现复杂背景下载机大机动飞行时光电***对丢失目标的快速重新捕获。其弥补了传统处理方法中没有考虑载机姿态角度变化的不足,实现了复杂背景和载机大机动飞行条件下光电***对丢失目标的快速自动捕获,为光电***保持对目标持续跟踪提供很好帮助。
Description
技术领域
本发明属于机载光电侦察技术领域,具体涉及一种用于机载光电观瞄***目标可靠跟踪的速度补偿方法,该方法可以在载机大机动飞行条件下保持光电***的瞄准线指向被遮挡目标,便于自动重新捕获目标。
背景技术
机载光电观瞄***(以下简称光电***)是战斗机、武装直升机和攻击无人机的“眼睛”。在现代信息化作战中,对光电***的使用要求除了“看得清、看得远”以外,在复杂背景条件下(如地面房屋、树木或地形起伏对目标的遮挡,导弹击发后的尾焰干扰等),如何保持对目标持续可靠跟踪是光电***设计时需要着重考虑的问题。只有保证对目标的可靠跟踪,才能抢占先机,提高打击效率。光电***的视频***主要工作模式包括‘跟踪’和‘记忆跟踪’模式,在‘跟踪’模式下锁定目标,当目标因遮挡消失后进入‘记忆跟踪’模式。在‘记忆跟踪’模式下(时间一般不小于5s),视频***在设定的像素区域内进行搜索和图像匹配处理,当原目标再次出现时重新捕获目标并自动进入‘跟踪’模式,这样操作员就不用手动操控搜索、瞄准目标,简化了操控流程,减轻了操作压力。所以,光电***在设计时必须采取某种控制方法,使得当‘跟踪’模式下被锁定的目标因被遮挡消失后,在‘记忆跟踪’模式下光电***的瞄准线仍能够按照其运动规律指向被遮挡目标区域,当目标再次出现,视频***能够自动重新捕获,保持对目标的持续跟踪。
对于光电***在跟踪时抗目标遮挡问题,传统的处理方法是在‘跟踪’模式下周期采集光电***陀螺组件输出的角速度信号,实时记录最新5~10帧数值,并对采集的数据取平均值或经最小二乘法处理,当进入‘记忆跟踪’后,用上述方法处理后的角速度值进行伺服补偿。这种方法的缺点是没有考虑到‘跟踪’和‘记忆跟踪’时间段载机姿态角度的变化,对不同时刻采集的陀螺角速度值没有统一到同一个坐标系下处理。当载机做机动飞行时,‘光电***瞄准线当前指向坐标系’是实时改变的(除了平移,还有旋转),光电***在‘跟踪’模式下各时刻采集的陀螺角速度值是在不同坐标系下的值,且‘记忆跟踪’时刻的‘光电***瞄准线当前指向坐标系’也与‘跟踪’时刻不同,所以这种处理方法只适用于载机姿态角度不发生大的变化的情况(如平飞)。另外,从以往的光电观瞄***试飞效果看,当载机做大幅度机动飞行时,用采集陀螺输出角速度信号的处理方法,在‘记忆跟踪’时刻光电***瞄准线会明显‘漂移’偏离目标,当目标重新出现时,由于已经偏离出设定的像素处理区域,***无法重新自动捕获目标。
发明内容
(一)要解决的技术问题
本发明要解决的技术问题是:如何提出一种适用于机载光电***在复杂背景下对目标可靠跟踪的速度补偿方法。基本原理是基于载机的姿态角度、矢量速度、海拔高度和光电***瞄准线的方位/俯仰角度,光电***在跟踪模式下实时解算目标在‘大地东-北-天坐标系’的速度,在记忆跟踪模式下实时解算目标在‘光电***当前瞄准线指向坐标系’下的方位/俯仰角速度,并使用该角速度值进行伺服补偿,使瞄准线指向被遮挡目标,实现复杂背景下载机大机动飞行时光电***对丢失目标的快速重新捕获。
(二)技术方案
为解决上述技术问题,本发明提供一种用于机载光电观瞄***目标可靠跟踪的速度补偿方法,所述方法包括以下步骤:
步骤1:光电***在‘跟踪’模式下锁定目标,实时计算ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标;
步骤2:‘跟踪’模式下,按照步骤1中ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标,用三点插值法周期计算ti时刻目标在‘大地东-北-天坐标系’的东向速度、北向速度、天向速度和东向加速度、北向加速度、天向加速度,直至得到光电***进入‘记忆跟踪’模式前的最后时刻,即T0时刻目标的速度和加速度值;
步骤3:‘记忆跟踪’模式下,按照步骤2中T0时刻目标在‘大地东-北-天坐标系’的东向速度、北向速度、天向速度和东向加速度、北向加速度、天向加速度,按照匀加速直线运动规律递推,得到‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的实时东向速度、北向速度、天向速度,然后再通过坐标变换得到tj时刻目标在‘光电***瞄准线当前指向坐标系’的实时速度;
步骤4:‘记忆跟踪’模式下,根据步骤3中目标在‘光电***瞄准线当前指向坐标系’方位方向、俯仰方向的实时速度,计算tj时刻目标相对光电***的方位、俯仰角速度;其中,所述步骤4中的方位方向即X轴、俯仰方向即Z轴。
其中,所述步骤1中,ti时刻是‘跟踪’模式下光电***主计算机任意一个计算周期开始时刻,ti-2、ti-1是ti往前一个、二个周期的开始时刻;‘跟踪’模式下任一时刻ti,目标在‘光电***瞄准线当前指向坐标系’的坐标是(0,ye_ti,0)T,与在‘载机东-北-天坐标系’中坐标(xti,yti,zti)T的转换公式为:
公式(1)中,Mti是‘跟踪’模式下ti时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’的转换矩阵,它由以下两个转换矩阵的乘积构成:1)‘惯导坐标系’到‘载机东-北-天坐标系’转换矩阵;2)‘光电***瞄准线当前指向坐标系’到‘惯导坐标系’转换矩阵;mpq_ti,p=1~3、q=1~3,是矩阵Mti的元素;hF_ti是‘跟踪’模式下ti时刻惯导***测量的载机海拔高度;矩阵相乘展开后的Mti各元素值如下:
m11_ti=cosαF_ti cosγF_ti cosθAZ_ti+sinαF_ti sinβF_ti sinγF_ti cosθAZ_ti–sinαF_ti cosβF_ti sinθAZ_ti;
m12_ti=cosαF_ti cosγF_ti sinθAZ_ti cosθEL_ti+sinαF_ti sinβF_ti sinγF_ti sinθAZ_ti cosθEL_ti+sinαF_ti cosβF_ti cosθAZ_ti cosθEL_ti+cosαF_ti sinγF_ti sinθEL_ti–sinαF_tisinβF_ti cosγF_ti sinθEL_ti;
m13_ti=–cosαF_ti cosγF_ti sinθAZ_ti sinθEL_ti–sinαF_ti sinβF_ti sinγF_ti sinθAZ_ti sinθEL_ti–sinαF_ti cosβF_ti cosθAZ_ti sinθEL_ti+cosαF_ti sinγF_ti cosθEL_ti–sinαF_tisinβF_ti cosγF_ti cosθEL_ti;
m21_ti=–sinαF_ti cosγF_ti cosθAZ_ti+cosαF_ti sinβF_ti sinγF_ti cosθAZ_ti–cosαF_ti cosβF_ti sinθAZ_ti;
m22_ti=–sinαF_ti cosγF_ti sinθAZ_ti cosθEL_ti+cosαF_ti sinβF_ti sinγF_ti sinθAZ_ti cosθEL_ti+cosαF_ti cosβF_ti cosθAZ_ti cosθEL_ti–sinαF_ti sinγF_ti sinθEL_ti–cosαF_tisinβF_ti cosγF_ti sinθEL_ti;
m23_ti=sinαF_ti cosγF_ti sinθAZ_ti sinθEL_ti–cosαF_ti sinβF_ti sinγF_ti sinθAZ_ti sinθEL_ti–cosαF_ti cosβF_ti cosθAZ_ti sinθEL_ti–sinαF_ti sinγF_ti cosθEL_ti–cosαF_tisinβF_tic osγF_ti cosθEL_ti;
m31_ti=–cosβF_ti sinγF_ti cosθAZ_ti–sinβF_ti sinθAZ_ti;
m32_ti=–cosβF_ti sinγF_ti sinθAZ_ti cosθEL_ti+sinβF_ti cosθAZ_ti cosθEL_ti+cosβF_ti cosγF_ti sinθEL_ti;
m33_ti=cosβF_ti sinγF_ti sinθAZ_ti sinθEL_ti–sinβF_ti cosθAZ_ti sinθEL_ti+cosβF_ti co sγF_ti cosθEL_ti;
(2)
公式(2)中,αF_ti、βF_ti、γF_ti是‘跟踪’模式下ti时刻惯导***测量的载机航向角、俯仰角、横滚角;θAZ_ti、θEL_ti是‘跟踪’模式下ti时刻光电***角度传感器测量的瞄线方位角、俯仰角;
根据公式(1),得到‘跟踪’模式下ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T。
其中,所述步骤2中,在‘跟踪’模式下,根据步骤1中计算得到的ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T,和惯导***测量的t(i-2)时刻载机的东向速度VINS_E_t[i-2]、北向速度VINS_N_t[i-2]、天向速度VINS_UP_t[i-2],t(i-1)时刻载机的东向速度VINS_E_t[i-1]、北向速度VINS_N_t[i-1]、天向速度VINS_UP_t[i-1],用插值法求解一阶、二阶导数,计算得到‘跟踪’模式下ti时刻目标在‘大地东-北-天坐标系’的东向即X轴上的速度Vx_ti、北向即Y轴上的速度Vy_ti、天向即Z轴上的速度Vz_ti和东向即X轴上加速度ax_ti、北向即Y轴上的加速度ay_ti、天向即Z轴上的加速度az_ti;求导时采用三点插值公式,得到的Vx_ti、Vy_ti、Vz_ti、ax_ti、ay_ti、az_ti,i=2,3,4,…。
其中,所述步骤2中,按以下公式得到‘跟踪’模式下ti时刻目标在‘大地东-北-天坐标系’的东向速度Vx_ti、北向速度Vy_ti、天向速度Vz_ti和东向加速度ax_ti、北向加速度ay_ti、天向加速度az_ti;
Vx_ti=(xt[i-2]-4xt[i-1]+3xti)/(2ΔT)+(-VINS_E_t[i-2]+3VINS_E_t[i-1])/2
Vy_ti=(yt[i-2]-4yt[i-1]+3yti)/(2ΔT)+(-VINS_N_t[i-2]+3VINS_N_t[i-1])/2
Vz_ti=(zt[i-2]-4zt[i-1]+3zti)/(2ΔT)+(-VINS_UP_t[i-2]+3VINS_UP_t[i-1])/2
ax_ti=(xt[i-2]-2xt[i-1]+xti)/ΔT2+(-VINS_E_t[i-2]+VINS_E_t[i-1])/ΔT
ay_ti=(yt[i-2]-2yt[i-1]+yti)/ΔT2+(-VINS_N_t[i-2]+VINS_N_t[i-1])/ΔT
az_ti=(zt[i-2]-2zt[i-1]+zti)/ΔT2+(-VINS_UP_t[i-2]+VINS_UP_t[i-1])/ΔT
(3)
上式中,(xt[i-2],yt[i-2],zt[i-2])T、(xt[i-1],yt[i-1],zt[i-1])T、(xti,yti,zti)T分别是‘跟踪’模式下t(i-2)、t(i-1)、ti时刻目标在‘载机东-北-天坐标系’的坐标值,通过步骤1中计算得到;(VINS_E_t[i-2]、VINS_N_t[i-2]、VINS_UP_t[i-2])T、(VINS_E_t[i-1]、VINS_N_t[i-1]、VINS_UP_t[i-1])T是‘跟踪’模式下t(i-2)、t(i-1)时刻载机在‘大地东-北-天坐标系’的东向速度、北向速度和天向速度,是惯导***的测量值;ΔT是计算周期,常量。
其中,所述步骤2中,在‘跟踪’模式下,按照公式(3)周期计算ti时刻目标在‘大地东-北-天坐标系’的实时速度和加速度,直至得到光电***进入‘记忆跟踪’模式前最后时刻,即T0时刻目标的速度和加速度值,记为(Vx_T0,Vy_T0,Vz_T0)T和(ax_T0,ay_T0,az_T0)T。
其中,所述步骤3中,在‘记忆跟踪’模式下,按照步骤2中参数(Vx_T0,Vy_T0,Vz_T0)T、(ax_T0,ay_T0,az_T0)T描述的匀加速直线运动规律递推目标在tj时刻的速度。‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的速度(Vx_tj,Vy_tj,Vz_tj)T公式为:
公式(4)中,N为光电***进入‘记忆跟踪’模式后的计算周期数;ΔT是计算周期,常量。
其中,所述步骤3中,
‘记忆跟踪’模式下,根据公式(4)所得tj时刻目标在‘大地东-北-天坐标系’的速度(Vx_tj,Vy_tj,Vz_tj)T,和惯导***测量的tj时刻载机的东向速度VINS_E_tj、北向速度VINS_N_tj、天向速度VINS_UP_tj,得到‘记忆跟踪’模式下tj时刻目标在‘光电***瞄准线当前指向坐标系’的速度(Vxe_tj,Vye_tj,Vze_tj)T公式为:
公式(5)中,Mtj T是Mtj的转置矩阵,即‘记忆跟踪’模式下tj时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’转换矩阵的转置矩阵,mpq_tj,p=1~3,q=1~3是矩阵元素,Vx_tj、Vy_tj、Vz_tj是‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的速度;VINS_E_tj、VINS_N_tj、VINS_UP_tj是‘记忆跟踪’模式下tj时刻惯导***测量的载机东向速度、北向速度和天向速度;
根据‘记忆跟踪’模式下tj时刻惯导***测量的载机方位角αF_tj、载机俯仰角βF_tj、载机横滚角γF_tj和光电***角度传感器测量的瞄准线方位角θAZ_tj,瞄准线俯仰角θEL_tj,用步骤1中公式(2)计算得到。
其中,所述步骤4中,‘记忆跟踪’模式下,公式(5)得到的目标在‘光电***瞄准线当前指向坐标系’的速度(Vxe_tj,Vye_tj,Vze_tj)中,Vxe_tj、Vze_tj就是tj时刻目标相对光电***在方位方向即‘光电***瞄准线当前指向坐标系’X轴、俯仰方向即‘光电***瞄准线当前指向坐标系’Z轴的实时速度;根据以下公式计算tj时刻目标相对光电***的方位角速度ωAZ_tj和俯仰角速度ωEL_tj,再用(ωAZ_tj,ωEL_tj)值在‘记忆跟踪’模式下进行伺服补偿,驱动光电***转动,使在目标遮挡情况下光电***瞄准线实时指向目标。
其中,所述步骤4中,按以下公式得到‘记忆跟踪’模式下tj时刻目标相对光电***的方位角速度ωAZ_tj和俯仰角速度ωEL_tj。
上式中,m32_tj是‘记忆跟踪’模式下tj时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’转换矩阵的转置矩阵Mtj T的元素;hF_tj是‘记忆跟踪’模式下tj时刻惯导***测量的载机海拔高度;HG是目标所在地域的平均海拔高度,常量。
其中,所述方法基于载机的姿态角度、矢量速度、海拔高度和光电***瞄准线的方位/俯仰角度,光电***在跟踪模式下实时解算目标在‘大地东-北-天坐标系’的速度,在记忆跟踪模式下实时解算目标在‘光电***当前瞄准线指向坐标系’下的方位/俯仰角速度,并使用该角速度值进行伺服补偿,使瞄准线指向被遮挡目标,实现复杂背景下载机大机动飞行时光电***对丢失目标的快速重新捕获。
(三)有益效果
与现有技术相比较,本发明针对地面运动目标被遮挡时如何保持对其可靠跟踪问题,提供一种用于机载光电观瞄***在复杂背景下对运动目标可靠跟踪的速度补偿方法,其技术方案中,光电***主计算机根据实时测量的载机姿态角度、矢量速度、海拔高度和光电***瞄准线的方位/俯仰角度等数据,在‘跟踪’模式下计算得到目标在‘大地东-北-天坐标系’的实时速度和加速度,然后按照匀加速直线运动规律递推得到目标被遮挡后在‘记忆跟踪’模式下的实时速度,再经过坐标转换得到‘记忆跟踪’模式下目标在‘光电***瞄准线当前指向坐标系’的角速度值并进行伺服补偿,使得光电***的瞄准线指向被遮挡目标区域。这样,当目标再次出现,视频***能够自动重新捕获,从而实现对目标的持续稳定跟踪和精确瞄准。
本发明技术方案弥补了传统的基于陀螺信号采集处理方法中没有考虑载机姿态角度变化的不足,实现了复杂背景和载机大机动飞行条件下光电***对丢失目标的快速自动捕获,减轻了操作员压力,为光电***保持对目标持续跟踪提供了很好的帮助。本发明技术方案已在相关光电观瞄***中进行了飞行验证。
附图说明
图1为本发明的技术方案的处理流程图。
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。
为解决现有技术问题,本发明提出一种适用于机载光电***在复杂背景下对目标可靠跟踪的速度补偿方法。其基本原理是基于载机的姿态角度、矢量速度、海拔高度和光电***瞄准线的方位/俯仰角度,光电***在跟踪模式下实时解算目标在‘大地东-北-天坐标系’的速度,在记忆跟踪模式下实时解算目标在‘光电***当前瞄准线指向坐标系’下的方位/俯仰角速度,并使用该角速度值进行伺服补偿,使瞄准线指向被遮挡目标,实现复杂背景下载机大机动飞行时光电***对丢失目标的快速重新捕获。
具体而言,如图1所示,本发明提供一种用于机载光电观瞄***目标可靠跟踪的速度补偿方法,
本方法中用于计算的常量、输入变量及坐标系定义如下:
1)HG是目标所在地域的平均海拔高度,是测量得到的常量;ΔT为计算周期,是设定的时间常量;
2)实时测量的数据包括:αF,βF,γF,VINS_E,VINS_N,VINS_UP,hF,θAZ,θEL;其中αF、βF、γF、VINS_E、VINS_N、VINS_UP、hF是惯导***测量的载机航向角、俯仰角、横滚角、东向速度、北向速度、天向速度、海拔高度;θAZ、θEL是光电***角度传感器测量的瞄准线方位角、俯仰角;以上变量作为计算输入量,变量符号的下标ti、tj(如αF_ti、αF_tj)表示是ti、tj时刻的值;上述各角度的正负定义及取值范围为,αF:载机顺时针旋转为正,逆时针旋转为负,0°~+360°;βF:载机抬头为正,低头为负,–90°~+90°;γF:沿前进方向载机右倾即顺时针为正,左倾即逆时针为负,–180°~+180°;θAZ:沿载机前进方向,光电***右转为正,左转为负,–180°~+180°;θEL:光电***抬头为正,低头为负,–90°~+90°;
3)本方法中用到的坐标系包括:
a)大地东-北-天坐标系:原点为大地表面某一点的固定坐标系,地球表面纬度圈切线方向即东向为X轴,地球表面经度圈切线方向即北向为Y轴,垂直于海平面即天向为Z轴的右手坐标系;
b)载机东-北-天坐标系:原点为载机上光电***质心点,东向为X轴,北向为Y轴,天向为Z轴的右手坐标系,与大地东-北-天坐标系平行;
c)惯导坐标系:原点为载机上惯导质心点,惯导沿载机前进方向的‘右侧’指向为X轴、沿载机前进方向为Y轴、过惯导质心点垂直于XY平面为Z轴的‘右-前-上’右手坐标系;
d)光电***瞄准线当前指向坐标系:原点为载机上光电***质心点,光电***前视方向的‘右侧’指向为X轴、前视方向为Y轴、过光电***质心点垂直于XY平面为Z轴的‘右-前-上’右手坐标系;
根据上述定义,所述用于机载光电观瞄***在复杂背景下对目标可靠跟踪的速度补偿方法,其采用以下步骤:
步骤1:光电***在‘跟踪’模式下锁定目标,计算ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标;其中,ti时刻是‘跟踪’模式下光电***主计算机任意一个计算周期开始时刻,ti-2、ti-1是ti往前一个、二个周期的开始时刻;‘跟踪’模式下任一时刻ti,目标在‘光电***瞄准线当前指向坐标系’的坐标是(0,ye_ti,0)T,与在‘载机东-北-天坐标系’中坐标(xti,yti,zti)T的转换公式为:
公式(1)中,Mti是‘跟踪’模式下ti时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’的转换矩阵,它由以下两个转换矩阵的乘积构成:1)‘惯导坐标系’到‘载机东-北-天坐标系’转换矩阵;2)‘光电***瞄准线当前指向坐标系’到‘惯导坐标系’转换矩阵;mpq_ti,p=1~3、q=1~3,是矩阵Mti的元素;hF_ti是‘跟踪’模式下ti时刻惯导***测量的载机海拔高度;矩阵相乘展开后的Mti各元素值如下:
公式(2)中,αF_ti、βF_ti、γF_ti是‘跟踪’模式下ti时刻惯导***测量的载机航向角、俯仰角、横滚角;θAZ_ti、θEL_ti是‘跟踪’模式下ti时刻光电***角度传感器测量的瞄线方位角、俯仰角;
根据公式(1),得到‘跟踪’模式下ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T;
步骤2:在‘跟踪’模式下,根据步骤1中计算得到的ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T,和惯导***测量的t(i-2)时刻载机的东向速度VINS_E_t[i-2]、北向速度VINS_N_t[i-2]、天向速度VINS_UP_t[i-2],t(i-1)时刻载机的东向速度VINS_E_t[i-1]、北向速度VINS_N_t[i-1]、天向速度VINS_UP_t[i-1],用插值法求解一阶、二阶导数,计算得到‘跟踪’模式下ti时刻目标在‘大地东-北-天坐标系’的东向即X轴上的速度Vx_ti、北向即Y轴上的速度Vy_ti、天向即Z轴上的速度Vz_ti和东向即X轴上加速度ax_ti、北向即Y轴上的加速度ay_ti、天向即Z轴上的加速度az_ti;求导时采用三点插值公式,得到的Vx_ti、Vy_ti、Vz_ti、ax_ti、ay_ti、az_ti(i=2,3,4,…)如下:
公式(3)中,(xt[i-2],yt[i-2],zt[i-2])T、(xt[i-1],yt[i-1],zt[i-1])T、(xti,yti,zti)T按照公式(1)计算得到;(VINS_E_t[i-2]、VINS_N_t[i-2]、VINS_UP_t[i-2])T、(VINS_E_t[i-1]、VINS_N_t[i-1]、VINS_UP_t[i-1])T是惯导***的测量值;ΔT是计算周期,常量;
在‘跟踪’模式下,按照公式(3)周期计算ti时刻目标在‘大地东-北-天坐标系’的实时速度和加速度,直至得到光电***进入‘记忆跟踪’模式前最后时刻,即T0时刻目标的速度和加速度值,记为(Vx_T0,Vy_T0,Vz_T0)T和(ax_T0,ay_T0,az_T0)T;
步骤3:在‘记忆跟踪’模式下,按照步骤2中参数(Vx_T0,Vy_T0,Vz_T0)T、(ax_T0,ay_T0,az_T0)T描述的匀加速直线运动规律递推目标在tj时刻的速度。‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的速度(Vx_tj,Vy_tj,Vz_tj)T公式为:
公式(4)中,N为光电***进入‘记忆跟踪’模式后的计算周期数;ΔT是计算周期,常量;
‘记忆跟踪’模式下,根据公式(4)所得tj时刻目标在‘大地东-北-天坐标系’的速度(Vx_tj,Vy_tj,Vz_tj)T,和惯导***测量的tj时刻载机的东向速度VINS_E_tj、北向速度VINS_N_tj、天向速度VINS_UP_tj,得到‘记忆跟踪’模式下tj时刻目标在‘光电***瞄准线当前指向坐标系’的速度(Vxe_tj,Vye_tj,Vze_tj)T公式为:
公式(5)中,Mtj T是Mtj的转置矩阵,即‘记忆跟踪’模式下tj时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’转换矩阵的转置矩阵,mpq_tj,p=1~3,q=1~3是矩阵元素,根据‘记忆跟踪’模式下tj时刻惯导***测量的载机方位角αF_tj、载机俯仰角βF_tj、载机横滚角γF_tj和光电***角度传感器测量的瞄准线方位角θAZ_tj,瞄准线俯仰角θEL_tj,用步骤1中公式(2)计算得到;
步骤4:‘记忆跟踪’模式下,公式(5)得到的目标在‘光电***瞄准线当前指向坐标系’的速度(Vxe_tj,Vye_tj,Vze_tj)中,Vxe_tj、Vze_tj就是tj时刻目标相对光电***在方位方向即‘光电***瞄准线当前指向坐标系’X轴、俯仰方向即‘光电***瞄准线当前指向坐标系’Z轴的实时速度;根据以下公式计算tj时刻目标相对光电***的方位角速度ωAZ_tj和俯仰角速度ωEL_tj,再用(ωAZ_tj,ωEL_tj)值在‘记忆跟踪’模式下进行伺服补偿,驱动光电***转动,使在目标遮挡情况下光电***瞄准线实时指向目标;
公式(6)中,m32_tj是‘记忆跟踪’模式下tj时刻矩阵Mtj T的元素;hF_tj是‘记忆跟踪’模式下tj时刻惯导***测量的载机海拔高度;HG是目标所在地域的平均海拔高度,常量。
[注:a)步骤1中的公式(1)、公式(2)是不同坐标系间的通用转换公式,步骤3中的公式(4)是计算匀加速运动目标速度的通用公式,这三个公式不作为本发明技术方案的核心内容;b)步骤2中的公式(3)、步骤3中的公式(5)、步骤4中的公式(6)是本专利所述方法的专有公式,是本发明技术方案的核心内容。]
实施例1
下面结合具体实施例描述本发明。本实施中设定数据如下:
1)计算周期ΔT=0.4s,目标所在地域的平均海拔高度HG=+460m。
2)光电***‘跟踪’模式下最后计算周期的开始时刻记为T0,T0-1、T0-2分别为T0往前一个和二个周期的开始时刻。设T0-2、T0-1、T0时刻,惯导***测量的载机航向角、俯仰角、横滚角、海拔高度的数据分别为:αF_[T0-2]=+340.30°,βF_[T0-2]=-0.26°,γF_[T0-2]=+1.13°,hF_[T0-2]=3513m;αF_[T0-1]=+340.20°,βF_[T0-1]=-0.24°,γF_[T0-1]=+1.16°,hF_[T0-1]=+3516m;αF_T0=+340.10°,βF_TO=-0.25°,γF_T0=+1.20°,hF_T0=+3520m。
3)‘跟踪’模式下T0-2、T0-1、T0时刻,光电***角度传感器测量的瞄线方位角、俯仰角数据分别为:θAZ_[T0-2]=+56.75°,θEL_[T0-2]=-58.82°;θAZ_[T0-1]=+56.10°,θEL_[T0-1]=-59.50°;θAZ_T0=+55.50°,θEL_T0=-60.15°。
4)‘跟踪’模式下T0-2、T0-1时刻,惯导***测量的载机的东向速度、北向速度、天向速度数据分别为:VINS_E_[T0-2]=-26.22(m/s),VINS_N_[T0-2]=+73.22(m/s),VINS_UP_[T0-2]=-0.35(m/s);VINS_E_[T0-1]=-26.35(m/s),VINS_N_[T0-1]=+73.18(m/s),VINS_UP_[T0-1]=-0.33(m/s)。
5)设T1是进入‘记忆跟踪’后的第一个计算周期时刻,即公式(4)中的周期数N=1。T1时刻,惯导***测量的载机的航向角、俯仰角、横滚角、海拔高度数据分别为:αF_T1=+340.00°,βF_T1=-0.23°,γF_T1=+1.25°,hF_T1=3524m;光电***角度传感器测量的瞄线方位角、俯仰角数据分别为:θAZ_T1=+54.90°,θEL_T1=-60.81°;惯导***测量的载机东向、北向、天向速度数据分别为:VINS_E_T1=-26.40(m/s),VINS_N_T1=+73.31(m/s),VINS_UP_T1=-0.31(m/s)。
以上测量数据中,计算周期的量纲是‘秒’(s),载机海拔高度和目标所在地域平均海拔高度的量纲是‘米’(m),角度的量纲是‘度’(°,计算时需转换为弧度),速度的量纲是‘米/秒’(m/s);计算过程中加速度的量纲是‘米/秒2’(m/s2);计算结果中方位角速度、俯仰角速度的量纲是‘弧度/秒’(1/s)。
本实施例的具体步骤如下:
步骤1:光电***在‘跟踪’模式下锁定目标,设‘跟踪’模式下最后计算周期的开始时刻为T0,T0-1、T0-2分别为T0往前一个和二个周期的开始时刻。
根据惯导***测量的T0-2、T0-1、T0时刻载机航向角αF_[T0-2]、αF_[T0-1]、αF_T0,俯仰角βF_[T0-2]、βF_[T0-1]、βF_T0,横滚角γF_[T0-2]、γF_[T0-1]、γF_T0,和光电***角度传感器测量的瞄线方位角θAZ_[T0-2]、θAZ_[T0-1]、θAZ_T0,俯仰角θEL_[T0-2]、θEL_[T0-1]、θEL_T0,按照公式(2)得到T0-2、T0-1、T0时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’的转换矩阵MT0-2、MT0-1、MT0为:
根据矩阵MT0-2、MT0-1、MT0的各元素值,惯导***测量的T0-2、T0-1、T0时刻载机海拔高度hF_[T0-2]、hF_[T0-1]、hF_T0和目标所在地域的平均海拔高度HG(常量),按照公式(1)得到T0-2、T0-1、T0时刻目标在‘载机东-北-天坐标系’的坐标为:
(xT0-2,yT0-2,zT0-2)T=(1049.06m,1424.86m,-3053.00m)T
(xT0-1,yT0-1,zT0-1)T=(1000.51m,1402.03m,-3056.00m)T
(xT0,yT0,zT0)T=(955.66m,1377.93m,-3060.00m)T
步骤2:在‘跟踪’模式下,根据步骤1中计算得到的T0-2、T0-1、T0时刻目标在‘载机东-北-天坐标系’的坐标(xT0-2,yT0-2,zT0-2)T、(xT0-1,yT0-1,zT0-1)T、(xT0,yT0,zT0)T和惯导***测量的T0-2、T0-1时刻载机的东向速度、北向速度、天向速度,用插值法求解一阶、二阶导数,按照公式(3)得到T0时刻目标在‘大地东-北-天坐标系’的东向速度Vx_T0、北向速度Vy_T0、天向速度Vz_T0和东向加速度ax_T0、北向加速度ay_T0、天向加速度az_T0为:
Vx_T0=-133.94m/s,Vy_T0=11.33m/s,Vz_T0=-11.57m/s
ax_T0=22.76m/s2,ay_T0=-8.03m/s2,az_T0=-6.20m/s2
步骤3:在‘记忆跟踪’模式下,按照步骤2中参数(Vx_T0,Vy_T0,Vz_T0)T、(ax_T0,ay_T0,az_T0)T描述的匀加速直线运动规律递推T1时刻目标在‘大地东-北-天坐标系’的速度(Vx_T1,Vy_T1,Vz_T1)T,其中T1是进入‘记忆跟踪’后的第一个计算周期时刻,即N=1。按照公式(4)得到(Vx_T1,Vy_T1,Vz_T1)T为:
Vx_T1=-124.84m/s,Vy_T1=8.11m/s,Vz_T1=-14.05m/s
根据惯导***测量的T1时刻载机航向角αF_T1、俯仰角βF_T1、横滚角γF_T1,和光电***角度传感器测量的瞄线方位角θAZ_T1、俯仰角θEL_T1,按照公式(2)得到T1时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’转换矩阵的转置矩阵MT1 T为:
根据以上得到的Vx_T1、Vy_T1、Vz_T1、矩阵MT1 T的值和惯导***测量的T1时刻载机东向速度VINS_E_T1、北向速度VINS_N_T1、天向速度VINS_UP_T1,按照公式(5)得到T1时刻目标在‘光电***瞄准线当前指向坐标系’的速度为:
(Vxe_T1,Vye_T1,Vze_T1)T=(-43.29m/s,-39.12m/s,-103.56m/s)T
步骤4:‘记忆跟踪’模式下,根据步骤3计算得到的T1时刻目标在‘光电***瞄准线当前指向坐标系’的速度Vxe_T1、Vze_T1(X轴、Z轴方向),和惯导***测量的载机海拔高度数据hF_T1,按照公式(6)得到T1时刻目标相对光电***的方位、俯仰角速度ωAZ_T1、ωEL_T1为:
ωAZ_T1=-0.012469(1/s),ωEL_T1=-0.029832(1/s)
本实例中只计算了‘记忆跟踪’模式下第一个计算周期(T1时刻)的方位、俯仰角速度ωAZ_T1、ωEL_T1,实际应用中需要在‘记忆跟踪’模式下周期计算、实时补偿。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (6)
1.一种用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其特征在于,所述方法包括以下步骤:
步骤1:光电***在‘跟踪’模式下锁定目标,实时计算ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标;其中,ti时刻是‘跟踪’模式下光电***主计算机任意一个计算周期开始时刻,ti-2、ti-1是ti往前二个、一个周期的开始时刻,即‘跟踪’模式下光电***主计算机任意一个计算周期往前二个、一个周期的开始时刻;
步骤2:‘跟踪’模式下,按照步骤1中ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标,和惯导***测量的ti-2时刻载机的东向速度VINS_E_ti-2、北向速度VINS_N_ti-2、天向速度VINS_UP_ti-2,ti-1时刻载机的东向速度VINS_E_ti-1、北向速度VINS_N_ti-1、天向速度VINS_UP_ti-1,用三点插值法周期计算ti时刻目标在‘大地东-北-天坐标系’的东向速度、北向速度、天向速度和东向加速度、北向加速度、天向加速度,直至得到光电***进入‘记忆跟踪’模式前的最后时刻,即T0时刻目标的速度和加速度值;
步骤3:‘记忆跟踪’模式下,按照步骤2中T0时刻目标在‘大地东-北-天坐标系’的东向速度、北向速度、天向速度和东向加速度、北向加速度、天向加速度,按照匀加速直线运动规律递推,得到‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的实时东向速度、北向速度、天向速度,然后再通过坐标变换得到tj时刻目标在‘光电***瞄准线当前指向坐标系’的实时速度;
步骤4:‘记忆跟踪’模式下,根据步骤3中目标在‘光电***瞄准线当前指向坐标系’方位方向、俯仰方向的实时速度,计算tj时刻目标相对光电***的方位、俯仰角速度;其中,所述步骤4中的方位方向即X轴、俯仰方向即Z轴;
所述步骤1中,‘跟踪’模式下任一时刻ti,目标在‘光电***瞄准线当前指向坐标系’的坐标是(0,ye_ti,0)T,与在‘载机东-北-天坐标系’中坐标(xti,yti,zti)T的转换公式为:
公式(1)中,Mti是‘跟踪’模式下ti时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’的转换矩阵,它由以下两个转换矩阵的乘积构成:1)‘惯导坐标系’到‘载机东-北-天坐标系’转换矩阵;2)‘光电***瞄准线当前指向坐标系’到‘惯导坐标系’转换矩阵;mpq_ti,p=1~3、q=1~3,是矩阵Mti的元素;hF_ti是‘跟踪’模式下ti时刻惯导***测量的载机海拔高度;HG是目标所在地域的平均海拔高度,是测量得到的常量;
矩阵相乘展开后的Mti各元素值如下:
m11_ti=cosαF_ticosγF_ticosθAZ_ti+sinαF_tisinβF_tisinγF_ticosθAZ_ti–sinαF_ticosβF_ tisinθAZ_ti;
m12_ti=cosαF_ticosγF_tisinθAZ_ticosθEL_ti+sinαF_tisinβF_tisinγF_tisinθAZ_ticosθEL_ti+sinαF_ticosβF_ticosθAZ_ticosθEL_ti+cosαF_tisinγF_tisinθEL_ti–sinαF_tisinβF_ticosγF_tisinθEL_ti;
m13_ti=–cosαF_ticosγF_tisinθAZ_tisinθEL_ti–sinαF_tisinβF_tisinγF_tisinθAZ_tisinθEL_ti–sinαF_ticosβF_ticosθAZ_tisinθEL_ti+cosαF_tisinγF_ticosθEL_ti–sinαF_tisinβF_ticosγF_ticosθEL_ti;
m21_ti=–sinαF_ticosγF_ticosθAZ_ti+cosαF_tisinβF_tisinγF_ticosθAZ_ti–cosαF_ticosβF_ tisinθAZ_ti;
m22_ti=–sinαF_ticosγF_tisinθAZ_ticosθEL_ti+cosαF_tisinβF_tisinγF_tisinθAZ_ticosθEL_ti+cosαF_ticosβF_ticosθAZ_ticosθEL_ti–sinαF_tisinγF_tisinθEL_ti–cosαF_tisinβF_ticosγF_tisinθEL_ti;
m23_ti=
sinαF_ticosγF_tisinθAZ_tisinθEL_ti–cosαF_tisinβF_tisinγF_tisinθAZ_tisinθEL_ti–cosαF_ ticosβF_ticosθAZ_tisinθEL_ti–sinαF_tisinγF_ticosθEL_ti–cosαF_tisinβF_ticosγF_ticosθEL_ti;
m31_ti=–cosβF_tisinγF_ticosθAZ_ti–sinβF_tisinθAZ_ti;
m32_ti=–cosβF_tisinγF_tisinθAZ_ticosθEL_ti+sinβF_ticosθAZ_ticosθEL_ti+cosβF_ticosγF_tisinθEL_ti;
m33_ti=cosβF_tisinγF_tisinθAZ_tisinθEL_ti–sinβF_ticosθAZ_tisinθEL_ti+cosβF_ticosγF_ ticosθEL_ti;(2)
公式(2)中,αF_ti、βF_ti、γF_ti是‘跟踪’模式下ti时刻惯导***测量的载机航向角、俯仰角、横滚角;θAZ_ti、θEL_ti是‘跟踪’模式下ti时刻光电***角度传感器测量的瞄准线方位角、俯仰角;
根据公式(1),得到‘跟踪’模式下ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T;
其中,所述步骤2中,在‘跟踪’模式下,根据步骤1中计算得到的ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T,和惯导***测量的ti-2时刻载机的东向速度VINS_E_ti-2、北向速度VINS_N_ti-2、天向速度VINS_UP_ti-2,ti-1时刻载机的东向速度VINS_E_ti-1、北向速度VINS_N_ti-1、天向速度VINS_UP_ti-1,用插值法求解一阶、二阶导数,计算得到‘跟踪’模式下ti时刻目标在‘大地东-北-天坐标系’的东向即X轴上的速度Vx_ti、北向即Y轴上的速度Vy_ti、天向即Z轴上的速度Vz_ti和东向即X轴上加速度ax_ti、北向即Y轴上的加速度ay_ti、天向即Z轴上的加速度az_ti;求导时采用三点插值公式得到Vx_ti、Vy_ti、Vz_ti、ax_ti、ay_ti、az_ti,i=2,3,4,…;
其中,所述步骤2中,按以下公式得到‘跟踪’模式下ti时刻目标在‘大地东-北-天坐标系’的东向速度Vx_ti、北向速度Vy_ti、天向速度Vz_ti和东向加速度ax_ti、北向加速度ay_ti、天向加速度az_ti;
Vx_ti=(xti-2-4xti-1+3xti)/(2ΔT)+(-VINS_E_ti-2+3VINS_E_ti-1)/2
Vy_ti=(yti-2-4yti-1+3yti)/(2ΔT)+(-VINS_N_ti-2+3VINS_N_ti-1)/2
Vz_ti=(zti-2-4zti-1+3zti)/(2ΔT)+(-VINS_UP_ti-2+3VINS_UP_ti-1)/2
ax_ti=(xti-2-2xti-1+xti)/ΔT2+(-VINS_E_ti-2+VINS_E_ti-1)/ΔT
ay_ti=(yti-2-2yti-1+yti)/ΔT2+(-VINS_N_ti-2+VINS_N_ti-1)/ΔT
az_ti=(zti-2-2zti-1+zti)/ΔT2+(-VINS_UP_ti-2+VINS_UP_ti-1)/ΔT(3)
上式中,(xti-2,yti-2,zti-2)T、(xti-1,yti-1,zti-1)T、(xti,yti,zti)T分别是‘跟踪’模式下ti-2、ti-1、ti时刻目标在‘载机东-北-天坐标系’的坐标值,通过步骤1中计算得到;(VINS_E_ti-2、VINS_N_ti-2、VINS_UP_ti-2)T、(VINS_E_ti-1、VINS_N_ti-1、VINS_UP_ti-1)T是‘跟踪’模式下ti-2、ti-1时刻载机在‘大地东-北-天坐标系’的东向速度、北向速度和天向速度,是惯导***的测量值;ΔT是计算周期,常量;
其中,所述步骤2中,在‘跟踪’模式下,按照公式(3)周期计算ti时刻目标在‘大地东-北-天坐标系’的实时速度和加速度,直至得到光电***进入‘记忆跟踪’模式前最后时刻,即T0时刻目标的速度和加速度值,记为(Vx_T0,Vy_T0,Vz_T0)T和(ax_T0,ay_T0,az_T0)T。
2.如权利要求1所述的用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其特征在于,所述步骤3中,在‘记忆跟踪’模式下,按照步骤2中参数(Vx_T0,Vy_T0,Vz_T0)T、(ax_T0,ay_T0,az_T0)T描述的匀加速直线运动规律递推目标在tj时刻的速度;‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的速度(Vx_tj,Vy_tj,Vz_tj)T公式为:
公式(4)中,N为光电***进入‘记忆跟踪’模式后的计算周期数;ΔT是计算周期,常量。
3.如权利要求2所述的用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其特征在于,所述步骤3中,在‘记忆跟踪’模式下,根据公式(4)所得tj时刻目标在‘大地东-北-天坐标系’的速度(Vx_tj,Vy_tj,Vz_tj)T,和惯导***测量的tj时刻载机的东向速度VINS_E_tj、北向速度VINS_N_tj、天向速度VINS_UP_tj,得到‘记忆跟踪’模式下tj时刻目标在‘光电***瞄准线当前指向坐标系’的速度(Vxe_tj,Vye_tj,Vze_tj)T公式为:
公式(5)中,Mtj T是Mtj的转置矩阵,即‘记忆跟踪’模式下tj时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’转换矩阵的转置矩阵,mpq_tj,p=1~3,q=1~3是矩阵元素,Vx_tj、Vy_tj、Vz_tj是‘记忆跟踪’模式下tj时刻目标在‘大地东-北-天坐标系’的速度;VINS_E_tj、VINS_N_tj、VINS_UP_tj是‘记忆跟踪’模式下tj时刻惯导***测量的载机东向速度、北向速度和天向速度;
根据‘记忆跟踪’模式下tj时刻惯导***测量的载机方位角αF_tj、载机俯仰角βF_tj、载机横滚角γF_tj和光电***角度传感器测量的瞄准线方位角θAZ_tj,瞄准线俯仰角θEL_tj,用步骤1中公式(2)计算得到mpq_tj。
4.如权利要求3所述的用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其特征在于,所述步骤4中,在‘记忆跟踪’模式下,公式(5)得到的目标在‘光电***瞄准线当前指向坐标系’的速度(Vxe_tj,Vye_tj,Vze_tj)中,Vxe_tj、Vze_tj就是tj时刻目标相对光电***在方位方向即‘光电***瞄准线当前指向坐标系’X轴、俯仰方向即‘光电***瞄准线当前指向坐标系’Z轴的实时速度;计算tj时刻目标相对光电***的方位角速度ωAZ_tj和俯仰角速度ωEL_tj,再用(ωAZ_tj,ωEL_tj)值在‘记忆跟踪’模式下进行伺服补偿,驱动光电***转动,使在目标遮挡情况下光电***瞄准线实时指向目标。
5.如权利要求4所述的用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其特征在于,所述步骤4中,按以下公式得到‘记忆跟踪’模式下tj时刻目标相对光电***的方位角速度ωAZ_tj和俯仰角速度ωEL_tj;
上式中,m32_tj是‘记忆跟踪’模式下tj时刻‘光电***瞄准线当前指向坐标系’到‘载机东-北-天坐标系’转换矩阵的转置矩阵Mtj T的元素;hF_tj是‘记忆跟踪’模式下tj时刻惯导***测量的载机海拔高度;HG是目标所在地域的平均海拔高度,常量。
6.如权利要求1所述的用于机载光电观瞄***目标可靠跟踪的速度补偿方法,其特征在于,所述方法基于载机的姿态角度、矢量速度、海拔高度和光电***瞄准线的方位/俯仰角度,光电***在跟踪模式下实时解算目标在‘大地东-北-天坐标系’的速度,在记忆跟踪模式下实时解算目标在‘光电***当前瞄准线指向坐标系’下的方位/俯仰角速度,并使用角速度值进行伺服补偿,使瞄准线指向被遮挡目标,实现复杂背景下载机大机动飞行时光电***对丢失目标的快速重新捕获。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110673639.6A CN113418523B (zh) | 2021-06-17 | 2021-06-17 | 用于机载光电观瞄***目标可靠跟踪的速度补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110673639.6A CN113418523B (zh) | 2021-06-17 | 2021-06-17 | 用于机载光电观瞄***目标可靠跟踪的速度补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113418523A CN113418523A (zh) | 2021-09-21 |
CN113418523B true CN113418523B (zh) | 2023-04-07 |
Family
ID=77788910
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110673639.6A Active CN113418523B (zh) | 2021-06-17 | 2021-06-17 | 用于机载光电观瞄***目标可靠跟踪的速度补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113418523B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6389333B1 (en) * | 1997-07-09 | 2002-05-14 | Massachusetts Institute Of Technology | Integrated flight information and control system |
CN105547295A (zh) * | 2016-01-25 | 2016-05-04 | 西安应用光学研究所 | 基于陀螺测速的机载光电观瞄***用地面目标无源测速方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8447517B2 (en) * | 2008-11-06 | 2013-05-21 | Texas Instruments Incorporated | Tightly-coupled GNSS/IMU integration filter having speed scale-factor and heading bias calibration |
US9681065B2 (en) * | 2010-06-15 | 2017-06-13 | Flir Systems, Inc. | Gimbal positioning with target velocity compensation |
WO2015126678A1 (en) * | 2014-02-20 | 2015-08-27 | Flir Systems, Inc. | Acceleration corrected attitude estimation systems and methods |
CN103693210A (zh) * | 2013-12-20 | 2014-04-02 | 河北汉光重工有限责任公司 | 一种机载光电吊舱视轴稳定的建模方法 |
CN109032153B (zh) * | 2018-05-31 | 2020-06-26 | 中国科学院西安光学精密机械研究所 | 基于光电-惯性组合导引的无人机自主着舰方法和*** |
CN110033480B (zh) * | 2019-04-19 | 2023-05-02 | 西安应用光学研究所 | 基于航摄测量的机载光电***目标运动矢量估计方法 |
CN111912427B (zh) * | 2019-05-10 | 2022-03-01 | 中国人民解放***箭军工程大学 | 一种多普勒雷达辅助捷联惯导运动基座对准方法及*** |
CN110658854B (zh) * | 2019-09-29 | 2023-03-14 | 凯迈(洛阳)测控有限公司 | 一种基于组合惯导信息应用的光电转塔视频跟踪前馈补偿方法 |
CN111238537B (zh) * | 2020-03-11 | 2023-06-02 | 西安应用光学研究所 | 机载光电观瞄***瞄准线漂移智能补偿方法 |
CN111366155B (zh) * | 2020-03-27 | 2022-10-14 | 西安应用光学研究所 | 基于机载光电***的局域扫描方法 |
-
2021
- 2021-06-17 CN CN202110673639.6A patent/CN113418523B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6389333B1 (en) * | 1997-07-09 | 2002-05-14 | Massachusetts Institute Of Technology | Integrated flight information and control system |
CN105547295A (zh) * | 2016-01-25 | 2016-05-04 | 西安应用光学研究所 | 基于陀螺测速的机载光电观瞄***用地面目标无源测速方法 |
Non-Patent Citations (1)
Title |
---|
闫明 ; 刘栋 ; 王惠林 ; 边 ; 刘国栋 ; 高贤娟 ; .机载光电观瞄***的瞄准线指向线性运动补偿方法.应用光学.2016,37(01),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN113418523A (zh) | 2021-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105258698B (zh) | 一种高动态自旋制导炮弹空中组合导航方法 | |
CN107727079B (zh) | 一种微小型无人机全捷联下视相机的目标定位方法 | |
US6244536B1 (en) | Air to air homing missile guidance | |
CN105157705B (zh) | 一种半捷联雷达导引头视线角速度提取方法 | |
CN111366148B (zh) | 适用于机载光电观瞄***多次观察的目标定位方法 | |
CN105698762A (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN106931967B (zh) | 一种助推-滑翔式临近空间飞行器的捷联惯性导航方法 | |
CN108733066B (zh) | 一种基于吊舱姿态反馈的目标跟踪控制方法 | |
CN102902282A (zh) | 基于光轴与惯性轴重合的地理跟踪方法 | |
CN111366155B (zh) | 基于机载光电***的局域扫描方法 | |
CN111238474A (zh) | 基于倾斜坐标系的捷联导引头非奇异视线角速度提取方法 | |
CN109143303A (zh) | 飞行定位方法、装置及固定翼无人机 | |
CN113670301A (zh) | 一种基于惯导***参数的机载sar运动补偿方法 | |
CN113418523B (zh) | 用于机载光电观瞄***目标可靠跟踪的速度补偿方法 | |
CN112833878A (zh) | 近地面多源天文自主导航方法 | |
US11037018B2 (en) | Navigation augmentation system and method | |
CN109471103B (zh) | 一种弹载双基sar数据融合定位误差修正方法 | |
CN112729305B (zh) | 一种基于单飞行器导引头图像信息的多目标定位方法 | |
CN110017809B (zh) | 利用地磁信息和光流传感器解算飞行器姿态的方法 | |
CN114442654B (zh) | 卫星图像复合制导方法 | |
CN109813302B (zh) | 最佳可用导航星快速确定方法 | |
CN113759982B (zh) | 一种仅基于视线测量信息的无人机编队相对状态估计方法 | |
CN112747743B (zh) | 基于弹载红外导引头的惯性视觉组合导航方法及装置 | |
CN112097765B (zh) | 一种采用定常与时变前置角相结合的飞行器前置导引方法 |
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 |