1.一种用于多普勒量测的预观测整体融合跟踪方法,其特征在于,获取k时刻目标状态的后验估计均值和协方差,则k时刻到k+1时刻的滤波具体步骤如下:S1:获取目标运动数据,构建匀速直线运动模型和匀加速直线运动模型,并在笛卡尔坐标系下分别对匀速直线运动模型和匀加速直线运动模型的目标状态及其协方差进行一步预测;
S2:对S1中得到的匀速直线运动模型和匀加速直线运动模型的目标状态及其协方差一步预测来计算量测预测及其协方差;
S3:获取目标多普勒雷达测量值并将多普勒雷达测量值转到笛卡尔坐标,并计算量测转换误差协方差;
S3中具体内容为:
将目标多普勒测量值转换到笛卡尔坐标:对上式计算期望:
无偏量测转换为:
式中,x
S4:在匀速直线运动模型和匀加速直线运动模型中通过加权最小二乘法线性融合S2中计算结果和S3中计算结果完成当前时刻目标跟踪状态和协方差的更新;
S4的具体内容为:
构建匀速直线运动模型的线性回归模型为:将上述矩阵方程记为Ax=b+e,e的协方差Var(e)记为V,则有:状态更新:X
协方差更新:Ρ
其中,x、y和
S5:循环执行步骤S1-S4,直至目标跟踪完成。
2.根据权利要求1所述的一种用于多普勒量测的预观测整体融合跟踪方法,其特征在于,S1中具体内容为:在笛卡尔坐标下对匀速直线运动模型目标状态和协方差一步预测的具体过程为:X
Ρ
式中,
笛卡尔坐标下对匀加速直线运动模型目标状态和协方差一步预测的具体过程为:X
Ρ
式中,
3.根据权利要求1所述的一种用于多普勒量测的预观测整体融合跟踪方法,其特征在于,S2中计算量测预测及其协方差具体公式如下:式中,r
4.根据权利要求1所述的一种用于多普勒量测的预观测整体融合跟踪方法,其特征在于,量测转换误差协方差具体表示为:式中,
5.根据权利要求1所述的一种用于多普勒量测的预观测整体融合跟踪方法,其特征在于,S4的具体内容为:
构造匀加速直线运动模型的线性回归模型为:将上述矩阵方程记为Ax=b+e,e的协方差Var(e)记为V,则有:状态更新:X
协方差更新:Ρ
其中,x、y、