[发明专利]一种空中目标跟踪方法有效
申请号: | 202110291295.2 | 申请日: | 2021-03-18 |
公开(公告)号: | CN113064154B | 公开(公告)日: | 2023-09-01 |
发明(设计)人: | 郭向坤;吕艳辉;张德育;王耀林 | 申请(专利权)人: | 沈阳理工大学 |
主分类号: | G01S13/72 | 分类号: | G01S13/72;G01S7/41 |
代理公司: | 沈阳东大知识产权代理有限公司 21109 | 代理人: | 李珉 |
地址: | 110159 辽*** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 空中 目标 跟踪 方法 | ||
1.一种空中目标跟踪方法,其特征在于,包括以下步骤:
步骤1:分析空中目标的运动情况,建立目标动力学模型;
设目标有n种运动状态,对应有n个运动模型,则第j个运动模型表示的目标状态方程为:
Xj(k+1)=Fj(k)Xj(k)+Gj(k)Wj(k)
观测方程为:
Zj(k)=Hj(k)Xj(k)+Vj(k)
其中,Fj(k)表示k时刻目标的状态转移矩阵,Xj(k)表示k时刻目标的状态矩阵,Gj(k)表示噪声驱动矩阵,Wj(k)表示均值为0,协方差为Qj(k)的高斯白噪声,Hj(k)表示k时刻目标的观测矩阵,Vj(k)表示均值为0,协方差为Rj(k)的高斯白噪声;
步骤2:将目标的运动状态方程和观测方程分别分解到坐标轴x、y、z上,使用交互式多模型算法IMM让目标在每个坐标轴的运动状态分别进行模型匹配,输出模型交互结果;
其中分解到x轴、y轴、z轴的状态方程分别为:
分解到x轴、y轴、z轴的观测方程分别为:
目标运动模型的转移概率用π表示,那么分别表示在x轴、y轴、z轴中模型从i转移j的转移概率:
其中,i,j=1,2,…,n,n为模型个数,各模型之间的转移服从马尔科夫过程;
令为k时刻滤波器的状态估计输出,则和分别为k时刻目标在x轴、y轴和z轴的状态估计,以下给出x轴的模型选择过程:
令为k时刻x轴的协方差矩阵,为k时刻x轴的模型j的概率,则模型j的一步预测概率为:
模型i到模型j的归一化概率为:
若由模型i转移到模型j,则k时刻模型j的混合状态估计为:
模型j的混合协方差估计为:
滤波残差,即新息为:
其中,Z(k+1)为k+1时刻的量测方程,为k+1时刻的量测预测值;
归一化的新息平方为:
εv(k)=v′(k)S-1(k)v(k)
其中,S(k)为新息协方差,εv(k)服从χ2分布;
步骤3:通过目标机动状态检测,使目标在每个时刻都自适应的从预先设置的滤波器集合中选择合适的滤波器进行滤波处理;
所述滤波器集合为适用于不同机动强度的N个滤波器组合的集合,集合中具有适应不同线性与非线性系统的滤波器,当x轴匹配的滤波器为卡尔曼滤波器时:
一步预测状态方程为:
一步预测的误差协方差为:
其中,Gj(k)表示噪声驱动矩阵;
增益为:
其中,Rj(k)为观测方程高斯白噪声的方差;
模型j的滤波残差为:
新息协方差为:
则模型j的可能性为:
模型j的概率为:
其中,
在对目标进行跟踪时,找出k时刻目标所匹配的模型中模型概率最大的模型,其对应的模型概率为则:
其中m为目标匹配运动模型的数量,μm(k)为第m个模型的模型匹配概率,然后利用对应模型的滤波在k时刻的新息对目标进行机动判别;
设threshold、thresholdmax为目标机动强度判别的门限值,则:
(1)当threshold≤εv(k)≤thresholdmax时,目标发生机动;
(2)当εv(k)>thresholdmax时,目标发生强机动;
(3)当εv(k)<threshold时,目标机动结束;
根据目标不同的机动状态从滤波器集合中选择合适的滤波器:
(1)当εv(k)<threshold时,选择卡尔曼滤波器;
(2)当threshold≤εv(k)≤thresholdmax时,选择扩展卡尔曼滤波器;
(3)当εv(k)>thresholdmax时,选择无迹卡尔曼滤波器;
步骤4:重复步骤2和步骤3,输出三维空间中各坐标轴的混合状态估计,实现对目标的跟踪,直至停止跟踪;
将步骤2中所述模型交互结果经滤波器滤波处理后,将各滤波器的在k时刻的状态估计、协方差估计以及模型的概率μ(k|k)进行输出、更新模型概率,计算出预测均方误差RMSE后跳转至步骤2进行下一次的递推操作;RMSE的计算方法如下:
其中,k时刻目标实际点的坐标为(xr,yr,zr),预测点的坐标为(xp,yp,zp),预测点的数量为n。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于沈阳理工大学,未经沈阳理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110291295.2/1.html,转载请声明来源钻瓜专利网。