转换坐标卡尔曼滤波算法在雷达数据融合中的应用
2011-07-05宋志强
仪器仪表用户 2011年4期
李 莉,宋志强
(中国人民解放军92941部队96分队,葫芦岛125000)
0 引言
转换坐标卡尔曼滤波算法是把极坐标系下的测量值经坐标变换到直角坐标系中,然后用统计方法求出转换后测量值误差的均值和方差,再利用标准卡尔曼滤波器进行滤波,滤波效果较好,将其应用于雷达数据融合处理中,可以有效提高目标跟踪精度。
1 转换坐标卡尔曼滤波算法中转换测量误差计算
假设有一二维坐标雷达固定在坐标原点,目标相对于雷达的真实位置为斜距r,方位角θ,雷达对目标的测量值为rm和θm。通过球坐标系向直角坐标系的标准转换方程,可把球坐标系下的测量值转换到直角坐标系下,得转换测量值xm,ym。设目标的真实位置在直角坐标系下表示为x,y,则直角坐标系下的转换测量误差为:

2 已知的条件下转换测量误差计算
在实际情况下目标的实际位置总是不知道的,我们所知道的是在球坐标系下对目标的测量值rm,θm,转换测量值误差的均值和方差由下面公式定义

由式(4)可计算出在测量值rm,θm已知条件下的转换测量值的均值为

同理可算出在测量已知的条件下转换测量值误差协方差矩阵Ra,其元素为

由式(8)可知,经坐标转换后,直角坐标系下的转换测量值是有偏的,用下式去偏

由式(9)得出的测量值是无偏的,成为去偏转换测量值。
3 转换坐标卡尔曼滤波算法应用
假设雷达跟踪目标作匀速直线运动,状态方程为:X(k+1)=FX(k)+ΓW(k)
式中,F为状态转移矩阵,X(k)为目标在k时刻的状态矢量,W(k)为k时刻的过程噪声,是零均值高斯白噪声。……
登录APP查看全文
