CN110657808B - 一种机载光电吊舱有源目标定位方法及*** - Google Patents
一种机载光电吊舱有源目标定位方法及*** Download PDFInfo
- Publication number
- CN110657808B CN110657808B CN201910982052.6A CN201910982052A CN110657808B CN 110657808 B CN110657808 B CN 110657808B CN 201910982052 A CN201910982052 A CN 201910982052A CN 110657808 B CN110657808 B CN 110657808B
- Authority
- CN
- China
- Prior art keywords
- target
- measured
- nacelle
- moment
- pod
- 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/20—Instruments for performing navigational calculations
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
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
本发明公开了一种机载光电吊舱有源目标定位方法及***,该方法包括:确定一个合作目标点,并获取合作目标点的经纬度;根据合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿;根据补偿后数据,采用目标单点定位算法确定tk‑1和tk时刻待测目标在ECEF坐标系下的坐标和根据和确定tk‑1时刻待测目标的速度;根据tk‑1时刻待测目标的速度和tk‑1时刻待测目标的坐标确定tk‑1时刻待测目标的状态Xk‑1,根据待测目标的状态Xk‑1,利用卡尔曼滤波方法对tk时刻待测目标的状态进行估计,得到tk时刻待测目标的估计状态根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计。通过本发明的上述方法实现对目标实时的高精度定位。
Description
技术领域
本发明涉及目标定位技术领域,特别是涉及一种机载光电吊舱有源目标定位方法及***。
背景技术
目标定位的主要任务是求取目标在大地坐标系下的三维坐标。在目标定位过程中,视频图像和遥测信息经数据链***传输至地面站显示,操纵手通过操纵杆及其它指令控制稳定平台和摄像***搜索侦察目标,当感兴趣的目标出现在画面上时,可以锁定并跟踪目标,使目标处于画面中心,冻结图像并将飞机平台的航空姿态测量数据、飞机接收GNSS导航信息、机载光电侦测平台自身的视轴位置、机载光电侦测平台的激光测距值发送至地面站计算机,地面计算机通过一系列的坐标变换,计算出目标的三维坐标。
目前常用的方法主要有两种:一种是利用目标单点定位算法对目标进行定位;另一种是递推最小二乘多点测距定位算法。
目标单点定位算法解算过程涉及到多个坐标系的转换,结合无人机姿态角、光电平台姿态角,计算出目标位置坐标,然而这种方法引入了无人机姿态角、光电平台姿态角,角度测量仪器存在测量误差,角度误差对定位误差的贡献极大,无人机姿态角误差以及光电平台姿态角误差二者会直接传递到对目标的定位误差上,且不易测量和消除,最终导致定位精度不高,计算出的目标定位结果误差不稳定且随机性大。
递推最小二乘多点测距定位算法,通过利用无人机航线上多个航点对目标进行测距,得到的测距信息作为测量信息进而计算得到目标的定位结果,这种方法称为最小二乘多点定位算法,最小二乘多点测距定位算法可进一步降低不良测量点对定位结果的影响,基于递推最小二乘多点测距算法对目标进行定位估计时,在距离近且目标为静态时定位精度高,误差可以控制在10m以内,但该方法存无法对动态目标进行定位以及测速的问题。
发明内容
基于此,本发明提供一种机载光电吊舱有源目标定位方法及***,实现对目标的实时定位。
为实现上述目的,本发明提供了如下方案:
一种机载光电吊舱有源目标定位方法,所述光电吊舱安装于无人机上,利用所述无人机对目标进行监测,并将监测数据发送至地面监控中心,所述地面监控中心通过所述监测数据对所述目标进行位置解算,所述目标定位方法包括:
确定一个合作目标点,并获取所述合作目标点的经纬度;
根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿;
根据所述tk-1时刻待测目标的状态Xk-1,利用卡尔曼滤波方法对tk时刻待测目标的状态进行估计,得到tk时刻待测目标的估计状态根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计,实现目标定位。
可选的,所述根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿,具体包括:
根据所述合作目标点确定无人机校飞路线,并在指定测量点对所述合作目标点进行观测,获取无人机经纬度和无人机姿态角;
获取合作目标在摄像机坐标系下的坐标TC、机载光电平台视轴方位角和机载光电平台视轴高低角;
根据所述机载光电平台视轴方位角和所述机载光电平台视轴高低角确定合作目标在导航坐标系下的坐标TN;
获取合作目标下吊舱实际方位角和吊舱实际高低角,分别记为第一吊舱实际方位角和第一吊舱实际高低角;
将所述吊舱理论方位角和吊舱理论高低角分别与所述第一吊舱实际方位角和第一吊舱实际高低角相应作差,得到吊舱方位角误差和吊舱高低角误差;
获取待测目标下吊舱实际方位角和吊舱实际高低角,分别记为第二吊舱实际方位角和第二吊舱实际高低角;
将所述吊舱方位角误差和所述吊舱高低角误差分别与所述第二吊舱实际方位角和第二吊舱实际高低角相应相加,得到补偿吊舱方位角和补偿吊舱高低角。
可选的,所述根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计,具体包括:
获取tk时刻的协方差Pk;
根据所述tk时刻的协方差Pk对tk+1时刻的协方差进行预测,确定tk+1时刻的预测协方差Pk+1/k;
获取tk+1时刻的测量矩阵Hk+1;
根据所述tk+1时刻的测量矩阵、所述tk时刻的协方差Pk和所述tk+1时刻的预测协方差Pk+1/k,确定tk+1时刻的滤波增益Yk+1;
根据所述tk+1时刻的预测协方差Pk+1/k、所述tk+1时刻的滤波增益Yk+1和所述tk+1时刻的测量矩阵Hk+1,确定tk+1时刻的协方差Pk+1。
一种机载光电吊舱有源目标定位***,所述光电吊舱安装于无人机上,利用所述无人机对目标进行监测,并将监测数据发送至地面监控中心,所述地面监控中心通过所述监测数据对所述目标进行位置解算,所述目标定位***包括:
经纬度获取模块,用于确定一个合作目标点,并获取所述合作目标点的经纬度;
补偿模块,用于根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿;
目标定位模块,用于根据所述tk-1时刻待测目标的状态Xk-1,利用卡尔曼滤波方法对tk时刻待测目标的状态进行估计,得到tk时刻待测目标的估计状态根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计,实现目标定位。
可选的,补偿模块,具体包括:
无人机经纬度和无人机姿态角获取单元,用于根据所述合作目标点确定无人机校飞路线,并在指定测量点对所述合作目标点进行观测,获取无人机经纬度和无人机姿态角;
数据获取单元,用于获取合作目标在摄像机坐标系下的坐标TC、机载光电平台视轴方位角和机载光电平台视轴高低角;
合作目标坐标确定单元,用于根据所述机载光电平台视轴方位角和所述机载光电平台视轴高低角确定合作目标在导航坐标系下的坐标TN;
吊舱理论方位角和吊舱理论高低角确定单元,用于根据所述地理坐标系N到载机坐标系B的旋转所述摄像机坐标系C到载机坐标系B的旋转所述合作目标在导航坐标系下的坐标TN和所述合作目标在摄像机坐标系下的坐标TC,确定吊舱理论方位角和吊舱理论高低角;
第一吊舱实际方位角和第一吊舱实际高低角获取单元,用于获取合作目标下吊舱实际方位角和吊舱实际高低角,分别记为第一吊舱实际方位角和第一吊舱实际高低角;
吊舱方位角误差和吊舱高低角误差确定单元,用于将所述吊舱理论方位角和吊舱理论高低角分别与所述第一吊舱实际方位角和第一吊舱实际高低角相应作差,得到吊舱方位角误差和吊舱高低角误差;
第二吊舱实际方位角和第二吊舱实际高低角获取单元,用于获取待测目标下吊舱实际方位角和吊舱实际高低角,分别记为第二吊舱实际方位角和第二吊舱实际高低角;
补偿吊舱方位角和补偿吊舱高低角确定单元,用于将所述吊舱方位角误差和所述吊舱高低角误差分别与所述第二吊舱实际方位角和第二吊舱实际高低角相应相加,得到补偿吊舱方位角和补偿吊舱高低角。
可选的,目标定位模块,具体包括:
协方差获取单元,用于获取tk时刻的协方差Pk;
协方差预测单元,用于根据所述tk时刻的协方差Pk对tk+1时刻的协方差进行预测,确定tk+1时刻的预测协方差Pk+1/k;
测量矩阵获取单元,用于获取tk+1时刻的测量矩阵Hk+1;
滤波增益确定单元,用于根据所述tk+1时刻的测量矩阵、所述tk时刻的协方差Pk和所述tk+1时刻的预测协方差Pk+1/k,确定tk+1时刻的滤波增益Yk+1;
可选的,所述目标定位模块还包括:
协方差确定单元,用于根据所述tk+1时刻的预测协方差Pk+1/k、所述tk+1时刻的滤波增益Yk+1和所述tk+1时刻的测量矩阵Hk+1,确定tk+1时刻的协方差Pk+1。
根据本发明提供的具体实施例,本发明公开了以下技术效果:
本发明利用合作目标点对确定无人机校飞路线,对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿,再利用卡尔曼滤波算法进行后续目标位置解算,从而实现对目标实时的高精度定位。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例一种机载光电吊舱有源目标定位方法的流程图;
图2为本发明实施例无人机目标定位示意图;
图3为本发明实施例一种机载光电吊舱有源目标定位***的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种机载光电吊舱有源目标定位方法及***,实现对目标的实时定位。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
传统的目标单点定位算法解算过程涉及到多个坐标系的转换,然后,结合无人机姿态角、光电平台姿态角,计算出目标位置坐标,图2为本发明实施例无人机目标定位示意图,如图2所示,机载光电吊舱视场中心锁定目标,激光光束照射目标,获得无人机与目标的距离(r)以及吊舱的高低角(beta)和方位角(alpha),则目标在ECEF坐标系经过一系列坐标转换下,满足下列关系:
其中,Tg为目标在ECEF坐标系下的坐标,Tc为目标在摄像机坐标系下的坐标,Pg为无人机在ECEF(笛卡尔)坐标系下的坐标,为大地直角坐标系G到地理坐标系N的旋转,为地理坐标系N到载机坐标系B的旋转,为载机坐标系B到基座坐标系T的旋转,为基座坐标系T到摄像机坐标系C的旋转。
式中各个矩阵定义如下:
其中,B0为无人机纬度,L0为无人机经度,yaw为无人机航向角,roll为无人机滚转角,pitch为无人机俯仰角,deta_yaw为吊舱与无人机航向安装误差角,deta_roll为吊舱与无人机滚转安装误差角,deta_pitch为吊舱与无人机俯仰安装误差角,deta_yaw_v为振动引起的吊舱航向误差角,deta_roll_v为振动引起的吊舱滚转误差角,deta_pitch_v为振动引起的吊舱俯仰误差角,alpha为吊舱方位角(alpha∈[0,2π)),beta为吊舱高低角
图1为本发明实施例一种机载光电吊舱有源目标定位方法的流程图。如图1所示,实施例一种机载光电吊舱有源目标定位方法,所述光电吊舱安装于无人机上,利用所述无人机对目标进行监测,并将监测数据发送至地面监控中心,所述地面监控中心通过所述监测数据对所述目标进行位置解算,所述目标定位方法包括:
S1:确定一个合作目标点,并获取所述合作目标点的经纬度。
S2:根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿。
S2具体包括:
根据所述合作目标点确定无人机校飞路线,并在指定测量点对所述合作目标点进行观测,获取无人机经纬度和无人机姿态角。
获取合作目标在摄像机坐标系下的坐标TC、机载光电平台视轴方位角和机载光电平台视轴高低角。
根据所述机载光电平台视轴方位角和所述机载光电平台视轴高低角确定合作目标在导航坐标系下的坐标TN。
具体的,合作目标在摄像机坐标系下的坐标TC和合作目标在导航坐标系下坐标TN两个向量存在如下关系:
假设TC=[0 1 0],
则TN=[sin(alpha_v)·cos(beta_v)cos(alpha_v)·cos(beta_v)sin(beta_v)]将式(2)展开可得:
令左边为TB,由式(3)右边的公式可得吊舱理论方位角和吊舱理论高低角的计算公式:
其中,TB是合作目标在机体坐标系下的坐标,alpha0表示吊舱理论方位角,beta0表示吊舱理论高低角。
获取合作目标下吊舱实际方位角和吊舱实际高低角,分别记为第一吊舱实际方位角和第一吊舱实际高低角。
将所述吊舱理论方位角和吊舱理论高低角分别与所述第一吊舱实际方位角和第一吊舱实际高低角相应作差,得到吊舱方位角误差和吊舱高低角误差。
计算公式如下:
其中,alphap0表示第一吊舱实际方位角,betap0表示第一吊舱实际高低角,δalpha表示吊舱方位角误差,δbeta表示吊舱高低角误差。
获取待测目标下吊舱实际方位角和吊舱实际高低角,分别记为第二吊舱实际方位角和第二吊舱实际高低角。
将所述吊舱方位角误差和所述吊舱高低角误差分别与所述第二吊舱实际方位角和第二吊舱实际高低角相应相加,得到补偿吊舱方位角和补偿吊舱高低角。
其中,alphap1表示第二吊舱实际方位角,betap1表示第二吊舱实际高低角,alpha1表示补偿吊舱方位角,beta1表示补偿吊舱高低角。
机载光电平台对目标绕飞过程中对目标进连续测距,利用线性卡尔曼滤波算法对待测目标状态进行滤波处理,获得逼近真实值的结果。
卡尔曼滤波器为线性滤波器,模型必须为线性的,设***的状态方程为
选取待测目标ECEF坐标系下的位置(xt,yt,zt)以及速度(vx,vy,vz)为状态,待测目标的状态X=(xt,yt,zt,vx,vy,vz)T,待测目标在ECEF坐标系下的位置为量测Tg=(xt,yt,zt)T。由于假设待测目标运动状态为匀速直线运动,因此状态方程可写为量测方程其中,Hk为测量测距,待测目标在ECEF坐标系下的位置。
S6:根据所述tk-1时刻待测目标的状态Xk-1,利用卡尔曼滤波方法对tk时刻待测目标的状态进行估计,得到tk时刻待测目标的估计状态根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计,实现目标定位。
S6具体包括:
获取tk时刻的协方差Pk;
根据所述tk时刻的协方差Pk对tk+1时刻的协方差进行预测,确定tk+1时刻的预测协方差Pk+1/k;
Pk+1/k=Φk+1/kPkΦk+1/k+ΓkQkΓk
其中,Qk为过程噪声,用于调整***建模的不准确性,Γk***噪声分配矩阵。
获取tk+1时刻的测量矩阵Hk+1。
根据所述tk+1时刻的测量矩阵、所述tk时刻的协方差Pk和所述tk+1时刻的预测协方差Pk+1/k,确定tk+1时刻的滤波增益Yk+1。
根据所述tk+1时刻的预测协方差Pk+1/k、所述tk+1时刻的滤波增益Yk+1和所述tk+1时刻的测量矩阵Hk+1,确定tk+1时刻的协方差Pk+1。
具体计算公式为:Pk+1=(I-Yk+1Hk+1)Pk+1/k。
通过本发明实施例的上述方法即可实时计算出待测目标在ECEF坐标系下的速度和位置。其中待测目标固定的精度可达20m以内,移动目标定位为40m以内,并可实现对移动目标运动趋势的跟踪定位。
图3为本发明实施例一种机载光电吊舱有源目标定位***的结构示意图,如图3所示,一种机载光电吊舱有源目标定位***,所述光电吊舱安装于无人机上,利用所述无人机对目标进行监测,并将监测数据发送至地面监控中心,所述地面监控中心通过所述监测数据对所述目标进行位置解算,所述目标定位***包括:
经纬度获取模块201,用于确定一个合作目标点,并获取所述合作目标点的经纬度。
补偿模块202,用于根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿。
待测目标坐标确定模块203,用于根据补偿后的吊舱方位角和吊舱高低角,采用目标单点定位算法确定tk-1时刻待测目标在ECEF坐标系下的坐标和tk时刻待测目标在ECEF坐标系下的坐标k=1,2,3...。
目标定位模块206,用于根据所述tk-1时刻待测目标的状态Xk-1,利用卡尔曼滤波方法对tk时刻待测目标的状态进行估计,得到tk时刻待测目标的估计状态根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计,实现目标定位。
补偿模块202,具体包括:
无人机经纬度和无人机姿态角获取单元,用于根据所述合作目标点确定无人机校飞路线,并在指定测量点对所述合作目标点进行观测,获取无人机经纬度和无人机姿态角。
数据获取单元,用于获取合作目标在摄像机坐标系下的坐标TC、机载光电平台视轴方位角和机载光电平台视轴高低角。
合作目标坐标确定单元,用于根据所述机载光电平台视轴方位角和所述机载光电平台视轴高低角确定合作目标在导航坐标系下的坐标TN。
吊舱理论方位角和吊舱理论高低角确定单元,用于根据所述地理坐标系N到载机坐标系B的旋转所述摄像机坐标系C到载机坐标系B的旋转所述合作目标在导航坐标系下的坐标TN和所述合作目标在摄像机坐标系下的坐标TC,确定吊舱理论方位角和吊舱理论高低角。
第一吊舱实际方位角和第一吊舱实际高低角获取单元,用于获取合作目标下吊舱实际方位角和吊舱实际高低角,分别记为第一吊舱实际方位角和第一吊舱实际高低角。
吊舱方位角误差和吊舱高低角误差确定单元,用于将所述吊舱理论方位角和吊舱理论高低角分别与所述第一吊舱实际方位角和第一吊舱实际高低角相应作差,得到吊舱方位角误差和吊舱高低角误差。
第二吊舱实际方位角和第二吊舱实际高低角获取单元,用于获取待测目标下吊舱实际方位角和吊舱实际高低角,分别记为第二吊舱实际方位角和第二吊舱实际高低角。
补偿吊舱方位角和补偿吊舱高低角确定单元,用于将所述吊舱方位角误差和所述吊舱高低角误差分别与所述第二吊舱实际方位角和第二吊舱实际高低角相应相加,得到补偿吊舱方位角和补偿吊舱高低角。
目标定位模块206,具体包括:
协方差获取单元,用于获取tk时刻的协方差Pk。
协方差预测单元,用于根据所述tk时刻的协方差Pk对tk+1时刻的协方差进行预测,确定tk+1时刻的预测协方差Pk+1/k。
测量矩阵获取单元,用于获取tk+1时刻的测量矩阵Hk+1。
滤波增益确定单元,用于根据所述tk+1时刻的测量矩阵、所述tk时刻的协方差Pk和所述tk+1时刻的预测协方差Pk+1/k,确定tk+1时刻的滤波增益Yk+1。
可选的,所述目标定位模块206还包括:
协方差确定单元,用于根据所述tk+1时刻的预测协方差Pk+1/k、所述tk+1时刻的滤波增益Yk+1和所述tk+1时刻的测量矩阵Hk+1,确定tk+1时刻的协方差Pk+1。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (6)
1.一种机载光电吊舱有源目标定位方法,所述光电吊舱安装于无人机上,利用所述无人机对目标进行监测,并将监测数据发送至地面监控中心,其特征在于,所述地面监控中心通过所述监测数据对所述目标进行位置解算,所述目标定位方法包括:
确定一个合作目标点,并获取所述合作目标点的经纬度;
根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿;
所述根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿,具体包括:
根据所述合作目标点确定无人机校飞路线,并在指定测量点对所述合作目标点进行观测,获取无人机经纬度和无人机姿态角;
获取合作目标在摄像机坐标系下的坐标TC、机载光电平台视轴方位角和机载光电平台视轴高低角;
根据所述机载光电平台视轴方位角和所述机载光电平台视轴高低角确定合作目标在导航坐标系下的坐标TN;
获取合作目标下吊舱实际方位角和吊舱实际高低角,分别记为第一吊舱实际方位角和第一吊舱实际高低角;
将所述吊舱理论方位角和吊舱理论高低角分别与所述第一吊舱实际方位角和第一吊舱实际高低角相应作差,得到吊舱方位角误差和吊舱高低角误差;
获取待测目标下吊舱实际方位角和吊舱实际高低角,分别记为第二吊舱实际方位角和第二吊舱实际高低角;
将所述吊舱方位角误差和所述吊舱高低角误差分别与所述第二吊舱实际方位角和第二吊舱实际高低角相应相加,得到补偿吊舱方位角和补偿吊舱高低角;
2.根据权利要求1所述的机载光电吊舱有源目标定位方法,其特征在于,所述根据上一时刻待测目标的估计状态,利用卡尔曼滤波方法对下一时刻的状态进行估计,具体包括:
获取tk时刻的协方差Pk;
根据所述tk时刻的协方差Pk对tk+1时刻的协方差进行预测,确定tk+1时刻的预测协方差Pk+1/k;
获取tk+1时刻的测量矩阵Hk+1;
根据所述tk+1时刻的测量矩阵、所述tk时刻的协方差Pk和所述tk+1时刻的预测协方差Pk+1/k,确定tk+1时刻的滤波增益Yk+1;
4.一种机载光电吊舱有源目标定位***,所述光电吊舱安装于无人机上,利用所述无人机对目标进行监测,并将监测数据发送至地面监控中心,其特征在于,所述地面监控中心通过所述监测数据对所述目标进行位置解算,所述目标定位***包括:
经纬度获取模块,用于确定一个合作目标点,并获取所述合作目标点的经纬度;
补偿模块,用于根据所述合作目标点的经纬度对后续待测目标定位过程中的吊舱方位角和吊舱高低角进行补偿;
所述补偿模块具体包括:
无人机经纬度和无人机姿态角获取单元,用于根据所述合作目标点确定无人机校飞路线,并在指定测量点对所述合作目标点进行观测,获取无人机经纬度和无人机姿态角;
数据获取单元,用于获取合作目标在摄像机坐标系下的坐标TC、机载光电平台视轴方位角和机载光电平台视轴高低角;
合作目标坐标确定单元,用于根据所述机载光电平台视轴方位角和所述机载光电平台视轴高低角确定合作目标在导航坐标系下的坐标TN;
吊舱理论方位角和吊舱理论高低角确定单元,用于根据所述地理坐标系N到载机坐标系B的旋转所述摄像机坐标系C到载机坐标系B的旋转所述合作目标在导航坐标系下的坐标TN和所述合作目标在摄像机坐标系下的坐标TC,确定吊舱理论方位角和吊舱理论高低角;
第一吊舱实际方位角和第一吊舱实际高低角获取单元,用于获取合作目标下吊舱实际方位角和吊舱实际高低角,分别记为第一吊舱实际方位角和第一吊舱实际高低角;
吊舱方位角误差和吊舱高低角误差确定单元,用于将所述吊舱理论方位角和吊舱理论高低角分别与所述第一吊舱实际方位角和第一吊舱实际高低角相应作差,得到吊舱方位角误差和吊舱高低角误差;
第二吊舱实际方位角和第二吊舱实际高低角获取单元,用于获取待测目标下吊舱实际方位角和吊舱实际高低角,分别记为第二吊舱实际方位角和第二吊舱实际高低角;
补偿吊舱方位角和补偿吊舱高低角确定单元,用于将所述吊舱方位角误差和所述吊舱高低角误差分别与所述第二吊舱实际方位角和第二吊舱实际高低角相应相加,得到补偿吊舱方位角和补偿吊舱高低角;
5.根据权利要求4所述的机载光电吊舱有源目标定位***,其特征在于,目标定位模块,具体包括:
协方差获取单元,用于获取tk时刻的协方差Pk;
协方差预测单元,用于根据所述tk时刻的协方差Pk对tk+1时刻的协方差进行预测,确定tk+1时刻的预测协方差Pk+1/k;
测量矩阵获取单元,用于获取tk+1时刻的测量矩阵Hk+1;
滤波增益确定单元,用于根据所述tk+1时刻的测量矩阵、所述tk时刻的协方差Pk和所述tk+1时刻的预测协方差Pk+1/k,确定tk+1时刻的滤波增益Yk+1;
6.根据权利要求5所述的机载光电吊舱有源目标定位***,其特征在于,所述目标定位模块还包括:
协方差确定单元,用于根据所述tk+1时刻的预测协方差Pk+1/k、所述tk+1时刻的滤波增益Yk+1和所述tk+1时刻的测量矩阵Hk+1,确定tk+1时刻的协方差Pk+1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910982052.6A CN110657808B (zh) | 2019-10-16 | 2019-10-16 | 一种机载光电吊舱有源目标定位方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910982052.6A CN110657808B (zh) | 2019-10-16 | 2019-10-16 | 一种机载光电吊舱有源目标定位方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110657808A CN110657808A (zh) | 2020-01-07 |
CN110657808B true CN110657808B (zh) | 2021-01-29 |
Family
ID=69041014
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910982052.6A Active CN110657808B (zh) | 2019-10-16 | 2019-10-16 | 一种机载光电吊舱有源目标定位方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110657808B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111366148B (zh) * | 2020-03-27 | 2022-11-22 | 西安应用光学研究所 | 适用于机载光电观瞄***多次观察的目标定位方法 |
CN112268558B (zh) * | 2020-10-15 | 2022-10-14 | 西北工业大学 | 一种基于无人机自主式光电平台的有源目标定位测速方法 |
CN113076634B (zh) * | 2021-03-24 | 2023-04-07 | 哈尔滨工业大学 | 一种多机协同无源定位方法、装置及*** |
CN113514052A (zh) * | 2021-06-10 | 2021-10-19 | 西安因诺航空科技有限公司 | 一种多机协同高精度有源目标定位方法及*** |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5672872A (en) * | 1996-03-19 | 1997-09-30 | Hughes Electronics | FLIR boresight alignment |
CN105675017A (zh) * | 2016-01-12 | 2016-06-15 | 山东理工大学 | 一种应用于光电平台的光纤陀螺随机漂移补偿方法 |
CN110274588A (zh) * | 2019-06-19 | 2019-09-24 | 南京航空航天大学 | 基于无人机集群信息的双层嵌套因子图多源融合导航方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9527392B2 (en) * | 2013-03-14 | 2016-12-27 | Aurora Flight Sciences Corporation | Aerial system and vehicle for continuous operation |
CN106871927B (zh) * | 2017-01-05 | 2020-10-20 | 南京航空航天大学 | 一种无人机光电吊舱安装误差标校方法 |
CN108663052B (zh) * | 2018-04-28 | 2019-07-12 | 北京空间飞行器总体设计部 | 一种星上自主空间非合作目标相对导航相机指向控制方法 |
CN109032153B (zh) * | 2018-05-31 | 2020-06-26 | 中国科学院西安光学精密机械研究所 | 基于光电-惯性组合导引的无人机自主着舰方法和*** |
CN110132283A (zh) * | 2019-05-28 | 2019-08-16 | 中国人民解放***箭军工程大学 | 一种无人机光电平台对地面静止目标定位方法及*** |
-
2019
- 2019-10-16 CN CN201910982052.6A patent/CN110657808B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5672872A (en) * | 1996-03-19 | 1997-09-30 | Hughes Electronics | FLIR boresight alignment |
CN105675017A (zh) * | 2016-01-12 | 2016-06-15 | 山东理工大学 | 一种应用于光电平台的光纤陀螺随机漂移补偿方法 |
CN110274588A (zh) * | 2019-06-19 | 2019-09-24 | 南京航空航天大学 | 基于无人机集群信息的双层嵌套因子图多源融合导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110657808A (zh) | 2020-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110657808B (zh) | 一种机载光电吊舱有源目标定位方法及*** | |
CN113311436B (zh) | 一种移动平台上激光测风雷达运动姿态测风订正方法 | |
CN105184776A (zh) | 目标跟踪方法 | |
CN110470304B (zh) | 一种基于无人机光电平台的高精度目标定位测速方法 | |
CN105549060A (zh) | 基于机载光电吊舱位置和姿态的目标定位*** | |
CN109827541B (zh) | 一种提高协同工作的多台光电经纬仪互引导精度的方法 | |
CN110220491B (zh) | 一种无人机的光学吊舱安装误差角估算方法 | |
CN106595668A (zh) | 一种用于光电吊舱的无源定位算法 | |
CN103900609B (zh) | 一种船用惯性导航***的航向精度实时检测***及检测方法 | |
JP2008304260A (ja) | 画像処理装置 | |
CN109581365B (zh) | 一种基于多旋翼无人机的生命探测***、方法 | |
CN111102981B (zh) | 一种基于ukf的高精度卫星相对导航方法 | |
CN103323855A (zh) | 一种基线动态测量***的精度获取方法 | |
US20210215831A1 (en) | Positioning apparatus and positioning method | |
CN110068817B (zh) | 一种基于激光测距和InSAR的地形测图方法、仪器和*** | |
CN110672871B (zh) | 一种基于组合惯导信息和光电转塔视频跟踪的运动目标测速测向方法 | |
CN108303120B (zh) | 一种机载分布式pos的实时传递对准的方法及装置 | |
CN115876197A (zh) | 一种系留升空光电成像目标定位方法 | |
CN114063054A (zh) | 一种火箭发射点参数的回溯计算方法 | |
US10473789B1 (en) | Real-time ship position error compensation system and method | |
CN109471102B (zh) | 一种惯组误差修正方法 | |
CN111897370B (zh) | 基于航姿仪的动态天线跟星参数校正方法 | |
CN112729305B (zh) | 一种基于单飞行器导引头图像信息的多目标定位方法 | |
CN115727856A (zh) | 一种卫星遥感图像自适应校正方法 | |
CN113155149B (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 |