APP下载

船舶远距离目标跟踪的数据融合算法

2023-07-22余建国

舰船科学技术 2023年12期
关键词:远距离卡尔曼滤波坐标系

余建国

(郑州航空工业管理学院 智能工程学院,河南 郑州 450046)

0 引 言

近年来,为了提高海上远距离目标的探测精度,船舶雷达系统不断进行技术迭代,分布式阵列地波雷达是一种新型雷达技术,该技术利用船舶的雷达阵列进行各个方位的目标探测,不仅能够弥补目前舰船单一雷达的探测技术局限性,还能提高雷达系统的抗干扰能力,利用多组雷达数据进行融合探测,显著提高远距离目标的探测精度。与此同时,在分布式阵列雷达系统中,数据的融合也成为一项影响系统性能的重要技术[1]。

本文针对舰船分布式阵列雷达进行以下研究:

1)针对分布式阵列雷达与目标物体的相对运动关系,建立舰船分布式阵列雷达的方位坐标系,在坐标系的基础上进行远距离目标探测的数学建模;

2)介绍一种卡尔曼滤波算法,针对舰船阵列雷达的信号采集进行滤波和预测;

3)介绍舰船阵列雷达远距离目标探测过程的目标融合算法,通过多个雷达传感器的数据融合,提高远距离目标的探测精度。

1 船舶分布式阵列雷达系统远距离目标探测的坐标系建模

在舰船分布式阵列雷达系统中,多个雷达探测器进行远距离目标探测时,往往以自身雷达探测器所在位置为坐标原点,在该原点建立坐标系表征被测目标的相对位置。这样就会导致不同雷达探测器针对同一被测目标的探测数据不一致,造成目标探测的校准出现问题。因此,对于舰船分布式阵列雷达系统,必须要建立统一的雷达坐标系,将阵列雷达系统的探测信息进行坐标系的转换。

本文建立远距离目标的阵列雷达坐标系统如图1 所示。

图1 远距离目标的阵列雷达坐标系统Fig. 1 Array radar coordinate system for long-range targets

在i时刻该坐标系统下,船舶航向角为θ,船舶速度为,远距离目标的移动速度为,当前位置远距离目标相对于船舶雷达的方位角[4]为θt,可得远距离目标的速度关系式:

定义远距离目标坐标系的原点坐标在雷达坐标系O-XYZ下的坐标为(λ0,φ0),远距离目标在自身坐标下的坐标为(λt,φt),位置坐标在O-XYZ下的投影为:

远距离目标的位置极坐标形式为:

在O-XYZ坐标系下观测到远距离目标的坐标为(x0,y0,z0),则可以得到位置配准模型为:

2 基于卡尔曼滤波算法的船舶雷达远距离目标跟踪数据融合算法

2.1 卡尔曼滤波算法

卡尔曼滤波算法是基于线性系统状态方程的输入和输出数据对比,进行系统噪声过滤,并对系统状态进行最优评估的一种算法。卡尔曼滤波算法利用系统的测量方差,可以推测动态系统的工作状态,目前,Kalman 滤波算法在通信、导航等多个领域得到了较好的应用。

卡尔曼滤波方法中条件方差、最小方差估计和条件均值估计理论算法是较为常用的算法,基于最小方差理论,卡尔曼滤波算法能够对系统的数据融合、数据精度等进行较准确的预测。

卡尔曼滤波算法的应用流程如图2 所示。

图2 卡尔曼滤波算法的应用流程图Fig. 2 Application flow chart of Kalman filter algorithm

建立线性系统的状态方程和观测方程如下式:

其中:Φ(k)为系统的n阶状态转移矩阵;Z(k)为m 维的测量向量;X(k)为n维的系统状态向量;Γ(k) 为n维p阶的输入矩阵;u(k)为系统的输入控制信号;G(k)为n维的噪声矩阵;V(k)为n维的过程噪声;H(k)m 维n阶的测量矩阵;W(k)为n 维测量噪声。

线性系统的过程噪声为高斯白噪声,定义如下:

δij为dirichlet 函数[2],符合:

基于卡尔曼滤波算法,可以得到状态的预测方程为:

基于卡尔曼滤波算法,可以得到测量的预测方程为:

预测量的协方差为:

状态量的协方差为:

系统的滤波增益矩阵为:

系统的状态量更新方程为:

系统的协方差更新方程为:

2.2 船舶远距离目标探测雷达与AIS 系统信号处理

船舶自动识别AIS 系统能够为船舶提供目标的方位信息,在远距离船舶目标探测过程中,可以利用AIS 系统数据和雷达探测数据,提高远距离目标探测的精度。

AIS 系统对船舶的定位采用地球坐标系,如图3所示。原点为地心,OZ轴指向北极,OX轴指向赤道,OY轴由地心指向赤道,雷达系统的坐标系如前文所述,可以用极坐标形式表示[3]。

图3 雷达极坐标系和AIS 地球坐标系的示意图Fig. 3 Schematic diagram of radar polar coordinate system and AIS earth coordinate system

图3 为雷达极坐标系和AIS 系统地球坐标系的示意图。

当目标方位角为θt,目标在雷达坐标系中表示为:

定义雷达探测的误差为:

式中:σl为距离方差,σs为角度方差,目标在AIS 系统的目标位置为(x0,y0,z0),可得坐标转换矩阵为:

2.3 船舶远距离目标探测的雷达信号建模

船舶雷达系统的远距离目标跟踪原理图如图4 所示。

图4 船舶雷达系统的远距离目标跟踪原理图Fig. 4 Long-range target tracking schematic of ship radar system

假设船舶分布式阵列雷达中第i个雷达天线发射的信号为:

式中:ki(t)为基带信号,fe为信号频率,雷达阵列之间满足:

式中:i、j为整数。

N个雷达天线的回波信号为:

式中:ζt为阵列天线回波信号的RCS 系数[4];S1为远距离目标的可被探测性;S0为远距离目标的不可测性,Kt为阵列雷达天线的信号增益;nt为空信号;E为天线功率;Qr为阵列增益,。

雷达信号频率调制模型为:

式中:µ为雷达信号的波长;f0为调制频率[6]。

则远距离目标k的跟踪模型可表示为:

式中:E0为距离导致的雷达信号功率损耗;fd为多普勒频率;τi为时延。

2.4 基于卡尔曼滤波的船舶远距离目标跟踪数据融合算法设计

使用卡尔曼滤波算法对船舶分布式阵列雷达的数据进行融合处理,每个雷达对远距离目标采集的独立跟踪数据通过航迹配对、融合后,形成最终的目标跟踪数据。

图5 为基于卡尔曼滤波算法的目标跟踪数据融合算法原理。

图5 基于卡尔曼滤波算法的目标跟踪数据融合算法原理Fig. 5 Principle of target tracking data fusion algorithm based on Kalman filter algorithm

定义每个雷达的测量值为X1,X2,···,Xn,每个雷达的测量方差为σi2,基于卡尔曼的加权融合均方差为:

图6 比较了船舶雷达常规目标观测的数据方差和基于数据融合的目标观测数据方差,可知基于数据融合算法的目标观测精度更高。

图6 融合观测与常规观测的目标探测数据方差对比Fig. 6 Contrast of target detection data variance between fusion observation and conventional observation

3 结 语

为了提高船舶阵列雷达对远距离目标探测和跟踪的精度,本文建立船舶雷达系统的位置模型,结合AIS 系统数据和卡尔曼滤波算法,实现了船舶阵列雷达的数据融合技术。

猜你喜欢

远距离卡尔曼滤波坐标系
零距离与远距离
解密坐标系中的平移变换
坐标系背后的故事
高速公路远距离供电系统
基于递推更新卡尔曼滤波的磁偶极子目标跟踪
捐献
基于重心坐标系的平面几何证明的探讨
远距离供电系统在滁马高速的应用
基于模糊卡尔曼滤波算法的动力电池SOC估计
基于扩展卡尔曼滤波的PMSM无位置传感器控制