量测时间间隔不等情况下的滤波器初始化方法技术

本发明专利技术公开了一种量测时间间隔不等情况下的滤波器初始化方法，属于雷达数据处理领域。利用卡尔曼类滤波算法对目标进行跟踪，首先需要对滤波器进行初始化处理，包括滤波状态初始化和滤波协方差阵初始化等。基于三时刻量测差分的滤波器初始化方法存在一个明显的缺陷，即当量测数据的时间间隔不等时无法直接其进行滤波器的初始化，难以适应信噪比低以及航迹起始不确定性等问题造成量测数据的间断或丢失的情况。本发明专利技术提出的量测时间间隔不等情况下的滤波器初始化方法立足于解决此类问题，对于有效增强卡尔曼类跟踪滤波算法的适应性具有重要的意义。实施例的实验仿真结果也表明本发明专利技术可以有效克服三时刻量测差滤波器初始化方法应用的局限性，因此本发明专利技术公开的量测时间间隔不等情况下的滤波器初始化方法具有较强的工程应用价值和推广前景。

【技术实现步骤摘要】

本专利技术涉及一种雷达数据处理方法，特别是涉及一种雷达量测数据时间间隔不等情况下基于卡尔曼类跟踪滤波(包括卡尔曼滤波、扩展卡尔曼滤波、量测转换卡尔曼滤波以及不敏卡尔曼滤波等)的滤波状态和滤波协方差阵的初始化方法，适应于雷达目标跟踪滤波领域。
技术介绍
利用卡尔曼类滤波算法对目标进行跟踪，首先需要对滤波器进行初始化处理，包括滤波状态初始化和滤波协方差阵初始化等。在利用雷达对目标进行探测跟踪时，由于目标信噪比低以及航迹起始的不确定性等问题可能造成量测数据的间断和丢失，从而导致用于滤波器初始化的量测数据时间间隔的不同，进而导致滤波器无法直接利用这些量测数据进行滤波器的初始化以及后续的目标跟踪滤波。因此，实现量测数据时间间隔不等情况下的滤波器直接初始化，对于增强卡尔曼类跟踪滤波算法的适应性具有重要的意义。目前的卡尔曼类跟踪滤波算法一般先对量测数据进行插值或平滑，得到时间间隔相等的量测数据，然后在此基础上采用三时刻量测差分法进行滤波器的初始化。该方法主要通过以下步骤实现：(1)确定用于滤波器初始化的三个时刻量测；(2)利用插值或平滑的方法获得时间间隔相等的三个时刻量测数据；(3)利用差分法得到初始滤波状态，并利用坐标转换将三个时刻雷达的量测误差换为直角坐标系下的量测误差，并计算得到初始滤波协方差阵。基于三时刻量测差分法的滤波器的初始化方法存在一个比较明显的缺陷：该方法通过对时间间隔不等的量测数据进行插值或平滑，得到时间间隔相等的量测数据，由于量测数据个数较少，插值和平滑过程会引入较大的误差，将导致滤波收敛速度较慢以及跟踪过程中协方差不能客观反映跟踪精度的现象。专利
技术实现思路
本专利技术的目的是提出一种量测时间间隔不等情况下的滤波器初始化方法，解决量测数据时间间隔不等情况下的卡尔曼类滤波器的直接初始化问题。本专利技术提出的量测时间间隔不等情况下的滤波器初始化方法的技术方案包括以下步骤：步骤1：利用3/4逻辑法进行航迹起始，确定用于滤波器初始化的三点量测Z(t1)＝(ρ1,θ1,β1,t1)，Z(t2)＝(ρ2,θ2,β2,t2)，Z(t3)＝(ρ3,θ3,β3,t3)，其中ρi、θi、βi和ti分别表示雷达测得目标的距离、方位角、俯仰角以及测量时刻，i＝1,2,3；步骤2：令X(ti)=xiyiziti=ρicosθicosβiρisinθicosβiρisinβiti,i=1,2,3]]>将雷达极坐标系下的三点量测Z(t1)，Z(t2)，Z(t3)分别转换成直角坐标系下的量测X(t1)，X(t2)，X(t3)；步骤3：令R(ti)=AiRAiT=r11(ti)r12(ti)r13(ti)r21(ti)r22(ti)r23(ti)r31(ti)r32(ti)r33(ti),i=1,2,3]]>将雷达极坐标下的量测误差矩阵R转换成直角坐标系下的量测误差矩阵R(t1)，R(t2)和R(t3)，其中Ai=cosθicosβi-ρisinθicosβi-ρicosθisinβisinθicosβiρicosθicosβi-ρisinθisinβisinβi0ρicosβi,i=1,2,3]]>和R=σR2000σθ2000σβ2]]>和分别为雷达在距离、方位、俯仰上的量测误差协方差，为Ai的转置；步骤4：令T1＝t2-t1，T2＝t3-t2，计算初始滤波状态X^(3|3)=x3(x3-x2)/T2[(x3-x2)/T2-(x2-x1)/T1]/[(T1+T2)/2]y3(y3-y2)/T2[(y3-y2)/T2-(y2-y1)/T1]/[(T1+T2)/2]z3(z3-z2)/T2[(z3-z2)/T2-(z2-z1)/T1]/[(T1+T2)/2]]]>和初始滤波协方差阵P^(3|3)=P11P12P13P21P22P23P31P32P33]]>其中Pij=rij(t3)rij(t3)T22rij(t3)(T1+T2)T2rij(t3)T2rij(t3)+rij(t2)T22rij(t3)/T2+rij(t2)T1+T2T1T212(T1+T2)T22rij(t3)(T1+T2)T2rij(t3)/T2+rij(t2)T1+T2T1T212(T1+T2)T2rij(t3)/T22+rij(t2)(T1+T2T1T2)2+rij(t1)/T12(T1+T22)2i=1,2,3;j=1,2,3,]]>步骤5：得到初始状态和初始协方差阵进行滤波器的初始化。和
技术介绍
相比，本专利技术的有益效果说明：本专利技术提出的雷达采样间隔不等情况下的滤波器初始化方法，可以直接利用量测时间间隔不等的数据进行滤波器的初始化，避免了传统方法需要首先对量测数据进行插值或平滑获得时间间隔相等的量测数据的过程，从而避免了插值或平滑过程引入的较大误差，扩大了卡尔曼类滤波器的适应范围。附图说明附图1是本专利技术提出的量测时间间隔不等情况下的滤波器初始化方法的整体流程图；附图2是本专利技术实施例中目标位置量测误差、位置跟踪误差、位置误差协方差比较图；附图3是本专利技术实施例中目标速度跟踪误差、速度跟踪误差协方差比较图；附图4是本专利技术实施例中目标加速度跟踪误差、加速度跟踪误差协方差比较图。具体实施方式下面结合附图对本专利技术提出的量测时间间隔不等情况下的滤波器初始化方法进行详细描述。假设单目标在(x,y,z)平面匀加速直线运动，初始位置(0m，5000m，0m)，x方向速度100m/s，y方向速度为100m/s，z方向速度为0m/s，x方向加速度5s/m2，y方向加速度为2s/m2，z方向速度为0s/m2。雷达不动，位置坐标为(0m，0m，0m)，量测误差在距离、方位、俯仰上的均方根分别为50m、0.2°、0.2°。3/4逻辑法航迹起始得到的三点量测如表1所示。本专利技术具体步骤如附图1所示。(1)按
技术实现思路
部分步骤1所述的方法进行3/4逻辑法航迹起始，确定用于滤波器初始化的三点量测，如表1所示；表1航迹起始确认的三点量测123距离(m)5184.29135155.59245719.8217方位角(rad)1.55351.52941.4446俯仰角(rad)-0.0009-0.0010-0.0028时标(s)126(2)按
技术实现思路
部分步骤2所述的方法将雷达极坐标系下的量测数据转换成直角坐标系下的量测数据，如表2所示；表2坐标转换后的三点量测123x(m)89.5951213.5742719.9668y(m)5183.51495151.16415674.3062z(m)-4.6823-5.1874-16.0606时标(s)126(3)按
技术实现思路
部分步骤3所述的方法将雷达极坐标下的量测误差矩阵转本文档来自技高网...

【技术保护点】
量测时间间隔不等情况下的滤波器初始化方法，其特征包括以下步骤： 步骤1：利用3/4逻辑法进行航迹起始，确定用于滤波器初始化的三点量测Z(t1)＝(ρ1,θ1,β1,t1)，Z(t2)＝(ρ2,θ2,β2,t2)，Z(t3)＝(ρ3,θ3,β3,t3)，其中ρi、θi、βi和ti分别表示雷达测得目标的距离、方位角、俯仰角以及测量时刻，i＝1,2,3； 步骤2：令X(ti)=xiyiziti=ρicosθicosβiρisinθicosβiρisinβiti,i=1,2,3]]> 将雷达极坐标系下的三点量测Z(t1)，Z(t2)，Z(t3)分别转换成直角坐标系下的量测X(t1)，X(t2)，X(t3)； 步骤3：令R(ti)=AiRAiT=r11(ti)r12(ti)r13(ti)r21(ti)r22(ti)r23(ti)r31(ti)r32(ti)r33(ti),i=1,2,3]]> 将雷达极坐标下的量测误差矩阵R转换成直角坐标系下的量测误差矩阵R(t1)，R(t2)和R(t3)，其中Ai=cosθicosβi-ρisinθicosβi-ρicosθisinβisinθicosβiρicosθicosβi-ρisinθisinβisinβi0ρicosβi,i=1,2,3]]> 和R=σR2000σθ2000σβ2]]>和分别为雷达在距离、方位、俯仰上的量测误差协方差，为Ai的转置； 步骤4：令T1＝t2‑t1，T2＝t3‑t2，计算初始滤波状态X^(3|3)=x3(x3-x2)/T2[(x3-x2)/T2-(x2-x1)/T1]/[(T1+T2)/2]y3(y3-y2)/T2[(y3-y2)/T2-(y2-y1)/T1]/[(T1+T2)/2]z3(z3-z2)/T2[(z3-z2)/T2-(z2-z1)/T1]/[(T1+T2)/2]]]> 和初始滤波协方差阵P^(3|3)=P11P12P13P21P22P23P31P32P33]]> 其中Pij=rij(t3)rij(t3)T22rij(t3)(T1+T2)T2rij(t3)T2rij(t3)+rij(t2)T22rij(t3)/T2+rij(t2)T1+T2T1T212(T1+T2)T22rij(t3)(T1+T2)T2rij(t3)/T2+rij(t2)T1+T2T1T212(T1+T2)T2rij(t3)/T22+rij(t2)(T1+T2T1T2)2+rij(t1)/T12(T1+T22)2i=1,2,3;j=1,2,3,]]>步骤5：得到初始状态和初始协方差阵进行滤波器的初始化。...

【技术特征摘要】
1.量测时间间隔不等情况下的滤波器初始化方法，其特征包括以下步骤：步骤1：利用3/4逻辑法进行航迹起始，确定用于滤波器初始化的三点量测Z(t1)＝(ρ1,θ1,β1,t1)，Z(t2)＝(ρ2,θ2,β2,t2)，Z(t3)＝(ρ3,θ3,β3,t3)，其中ρi、θi、βi和ti分别表示雷达测得目标的距离、方位角、俯仰角以及测量时刻，i＝1,2,3；步骤2：令X(ti)=xiyiziti=ρicosθicosβiρisinθicosβiρisinβiti,i=1,2,3]]>将雷达极坐标系下的三点量测Z(t1)，Z(t2)，Z(t3)分别转换成直角坐标系下的量测X(t1)，X(t2)，X(t3)；步骤3：令R(ti)=AiRAiT=r11(ti)r12(ti)r13(ti)r21(ti)r22(ti)r23(ti)r31(ti)r32(ti)r33(ti),i=1,2,3]]>将雷达极坐标下的量测误差矩阵R转换成直角坐标系下的量测误差矩阵R(t1)，R(t2)和R(t3)，其中Ai=cosθicosβi-ρisinθicosβi-ρicosθisinβisinθicosβiρicosθicosβi-ρisinθisinβisinβi0ρicos&b...

【专利技术属性】
技术研发人员：谭顺成，王国宏，吴巍，
申请(专利权)人：谭顺成，
类型：发明
国别省市：山东;37