一种双基地雷达的空间目标跟踪滤波装置及方法
技术领域
本发明涉及一种空间目标跟踪滤波方法,尤其涉及的是一种双基地雷达的空间目标跟踪滤波装置及方法。
背景技术
常见的单基地雷达采用收发同置,雷达既是发射站也是接收站。其目标测量值为(R,A,E),其中R,A,E分别是目标到接收站的距离、方位角、俯仰角。与此不同的是,双基地雷达的发射站和接收站是分置的,其目标测量值为(R∑,A,E),其中R∑=RR+RT,R∑是目标到发射站距离RT与其到接收站距离RR之和,A,E是目标到接收站的方位角、俯仰角。因此,为了实现双基地雷达对目标的跟踪,传统做法为先解算收到的目标量测值,获得近似的目标到接收站的距离后再进行滤波。
如图1所示,传统的双基地雷达对目标的跟踪滤波方法如下:
步骤101、102,完成雷达坐标系与滤波参数的初始化;其中,滤波参数包括量测噪声的协方差及初始协方差矩阵;
步骤103,收到雷达的第i个量测点(R
i∑,A
i,E
i);采用椭圆法单基距解算法解算空间目标到接收站的距离:
式中,L为基线距离,θiR为双基平面上接收站目标视角;
步骤104,对(RiR,Ai,Ei)进行UKF滤波;
步骤105、106,重复步骤103、104,直到目标跟踪结束。
在上述传统跟踪滤波过程中,由于单基距的解算没有考虑地球扁率的影响,导致解算误差较大,距离精度只能达到公里级别,甚至10公里级别,远远不能满足跟踪雷达的精度要求。
发明内容
本发明所要解决的技术问题在于:如何提高空间目标的跟踪效率和精度,提供了一种双基地雷达的空间目标跟踪滤波装置及方法。
本发明是通过以下技术方案解决上述技术问题的,本发明的一种双基地雷达的空间目标跟踪滤波装置,包括初始化模块、数据预处理模块、滤波处理模块和显示模块;
所述初始化模块分别连接数据预处理模块和滤波处理模块,用于完成雷达坐标、坐标系参数、滤波参数的初始化,以及目标首点和第二点的坐标解算;
所述数据预处理模块接收雷达量测的实时点迹信息(R∑,θ),完成点迹数据补距离多普勒耦合,同时剔除异常点,将首点数据传输给初始化模块,R∑表示目标分别到发射站与接收站的距离之和,即R∑=RT+RR,RT为目标到发射站的距离、RR为目标到接收站的距离,θ表示接收站目标视角;
所述滤波处理模块连接数据预处理模块,用于对雷达量测的点迹数据进行滤波处理,基于空间目标运动方程,无需对量测点做单基距解算获取RR,直接采用目标的距离和R∑进行滤波;
所述显示模块连接滤波处理模块和数据预处理模块,用于接收并显示点迹数据、航迹数据、时统信息和波束指向信息。
一种使用所述的双基地雷达的空间目标跟踪滤波装置进行跟踪滤波的方法,包括以下步骤:
(1)完成雷达坐标系初始化;
(2)完成滤波参数的初始化,包括量测噪声的协方差与初始协方差矩阵的设置;
(3)对第i个量测点进行滤波;
所述滤波过程如下:
(31)设第k-1时刻融合中心的状态估计向量为
状态估计协方差为P
k-1|k-1,对该点进行不敏变换的采样点选取:
其中,状态向量维数L=7,λ=α2(L+κ)为比例参数,用于控制采样点到均值的距离;通常α=0.5;κ=3-L;β=2;
(32)对各采样点χi,k-1|k-1计算第k时刻的状态预测:
ξi,k|k-1=f(χi,k-1|k-1,k-1)
其中,f(x)表示空间目标的运动方程;
(33)计算第k时刻的量测预测:
ζi,k|k-1=h(ξi,k|k-1,k)
其中,h(x)为双基地雷达的空间目标量测方程;
(34)获得第k时刻的滤波值:
首先计算第k时刻测量和状态向量的交互协方差
如果第k时刻雷达所提供的测量量为Yk,则状态更新方程为
其中,计算增益:
相应的状态更新协方差为:
(4)重复步骤(3)直到目标跟踪结束。
初始化处理包括观测到空间目标后解算其首点在地心地固ECEF坐标系下坐标和速度,具体过程如下:
(11)收到来自雷达的空间目标量测首点和第二点(R1∑,A1,E1)、(R2∑,A2,E2),其中,Ri∑=RiT+RiR,RiR为空间目标第i点到接收站的距离,RiT为空间目标第i点到发射站的距离,Ai,Ei分别为空间目标第i点到接收站的方位角和俯仰角;
(12)解算目标前两点到接收站的距离RiR,即获得目标前两点的在雷达极坐标系下的坐标;
(13)采用坐标系转换方法将其从雷达极坐标系转换到地心地固坐标系ECEF下;
(14)利用差分法计算出目标首点在ECEF下的坐标和速度。
所述空间目标的运动方程为:
式中,
X=(x,y,z)是地心地固坐标系下的卫星位置,μ=3.985325·10
14Nm
2kg
-1为地球引力常数,a
e为地球平均赤道半径,J
2为地球二阶带谐项系数,
为地固系下的日月引力加速度。
所述双基地雷达的空间目标量测方程为:
式中,Rk∑为预测的第k时刻空间目标到接收站与发射站的距离和,(xk,yk,zk)为预测的第k时刻目标在地心地固坐标系中的位置坐标,(xR,yR,zR)为接收站坐标,(xT,yT,zT)为发射站坐标。
本发明相比现有技术具有以下优点:本发明基于空间目标运动方程和UnscentKalman Filter(UKF无际卡尔曼滤波)法,在目标的跟踪滤波过程中,无需先解算出目标到接收站的距离,消除了该步骤中产生误差的可能。新算法克服了现有双基地雷达目标跟踪技术的缺点和不足,有效提高了雷达空间目标跟踪的效率和精度。
附图说明
图1是传统双基地雷达空间目标跟踪滤波流程图;
图2是本发明双基地雷达空间目标跟踪滤波流程图;
图3是本发明的结构框图;
图4是量测/滤波距离和与星历距离和一次差图;
图5是量测/本发明滤波距离和与星历距离和一次差对比图;
图6是量测/滤波方位与星历方位一次差图;
图7是量测/滤波俯仰与星历俯仰一次差图。
具体实施方式
下面对本发明的实施例作详细说明,本实施例在以本发明技术方案为前提下进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
如图3所示,本实施例的一种双基地雷达的空间目标跟踪滤波装置,包括初始化模块、数据预处理模块、滤波处理模块和显示模块;
所述初始化模块分别连接数据预处理模块和滤波处理模块,用于完成雷达坐标、坐标系参数、滤波参数的初始化,以及目标首点和第二点的坐标解算;
所述数据预处理模块接收雷达量测的实时点迹信息(R∑,θ),完成点迹数据补距离多普勒耦合,同时剔除异常点,将首点数据传输给初始化模块,R∑表示目标分别到发射站与接收站的距离之和,即R∑=RT+RR,RT为目标到发射站的距离、RR为目标到接收站的距离,θ表示接收站目标视角;
所述滤波处理模块连接数据预处理模块,用于对雷达量测的点迹数据进行滤波处理,基于空间目标运动方程,无需对量测点做单基距解算获取RR,直接采用目标的距离和R∑进行滤波;
所述显示模块连接滤波处理模块和数据预处理模块,用于接收并显示点迹数据、航迹数据、时统信息和波束指向信息。
如图2所示,本实施例的双基地雷达空间目标跟踪滤波流程如下:
步骤201和202,完成雷达坐标系与滤波参数的初始化;其中,滤波参数包括量测噪声的协方差及初始协方差矩阵;
步骤203和204,对第i个量测点进行滤波;
步骤205,重复步骤203、204,直到目标跟踪结束。
本实施例的滤波方法如下:
第一步,设第k-1时刻融合中心的状态估计向量为
状态估计协方差为P
k-1|k-1。对该点进行不敏变换的采样点选取,公式如下:
其中,状态向量维数L=7,λ=α2(L+κ)为比例参数,用于控制采样点到均值的距离;通常α=0.5;κ=3-L;β=2;
第二步,对各采样点χi,k-1|k-1计算第k时刻的状态预测:
ξi,k|k-1=f(χi,k-1|k-1,k-1)
进而获得状态预测估计:
以及状态预测协方差为:
其中,f(x)表示空间目标的运动方程:
式中,
X=(x,y,z)是地心地固坐标系下的卫星位置,μ=3.985325·10
14Nm
2kg
-1为地球引力常数,a
e为地球平均赤道半径,J
2为地球二阶带谐项系数,
为地固系下的日月引力加速度;
第三步,计算第k时刻的量测预测:
ζi,k|k-1=h(ξi,k|k-1,k)
进而获得状态预测估计:
以及相应协方差为:
其中,h(x)为双基地雷达的空间目标量测方程:
式中,Rk∑为预测的第k时刻空间目标到接收站与发射站的距离和,(xk,yk,zk)为预测的第k时刻目标在地心地固坐标系中的位置坐标,(xR,yR,zR)为接收站坐标,(xT,yT,zT)为发射站坐标;
第四步,获得第k时刻的滤波值:
首先计算第k时刻测量和状态向量的交互协方差:
如果第k时刻雷达所提供的测量量为Yk,则状态更新方程为:
其中,计算增益:
相应的状态更新协方差为:
本实施例采用一段真实的空间目标观测数据进行跟踪滤波。新旧算法滤波效果对比如图 4~7。如图4所示,采用旧算法后目标的距离和一次差约在10000米左右,且逐步发散;如图5所示,而采用本发明的新算法后,目标的距离和一次差<30米。如图6所示,采用旧算法后目标的方位角一次差范围在[1.4度,0.4度]区间内,而采用本发明的新算法后,方位角一次差为-0.02度左右。如图7所示,采用旧算法后目标的俯仰角一次差在0.3度左右,而采用本发明的新算法后,俯仰角一次差为-0.01度左右。综上所述,本发明的新算法大大提高了目标跟踪的滤波精度。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。