1.一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,包括以下步骤:步骤1、确定极坐标下含有径向速度并与多普勒雷达测量呈线性关系的匀速直线运动模型和匀加速直线运动模型的状态方程;
步骤2、将匀速直线运动模型和匀加速直线运动模型笛卡尔坐标系下的过程噪声转换到极坐标,使用Unscented变换计算过程噪声的均值和协方差;
步骤3、基于笛卡尔坐标下的先验信息,对获得的匀速直线运动模型和匀加速直线运动模型的状态方程进行状态初始化,利用蒙特卡洛方法初始化目标在极坐标中的目标状态和协方差;
步骤4、在当前时刻,根据运动目标加速度的先验信息选择运动模型,计算极坐标下状态方程的状态转移矩阵,过程噪声驱动矩阵和过程噪声的统计特性;
步骤5、在极坐标下对目标状态和协方差一步预测;
步骤6、结合多普勒雷达测量值,通过最小方差线性融合完成当前时刻目标跟踪状态和协方差的更新;
步骤7、循环执行步骤4‑6,直至目标跟踪结束。
2.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,确定极坐标下匀速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀速直线运动模型在极坐标系中的状态方程表示为:ηRV‑CV(k+1)=ΦRV‑CV(k)ηRV‑CV(k)+ΓRV‑CV(k)ωRV‑CV(k);
式中, 表示k时刻目标的状态,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值, 分别为角速度和径向速度;
代表r(k), 之间的协方差, Var[r(k)]分别代表 r(k)的方差,ΦRV‑CV(k)为状态转移矩阵,ΓRV‑CV(k)为过程噪声驱动矩阵,ωRV‑CV(k)为过程噪声。
3.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,确定极坐标下匀加速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀加速直线运动模型在极坐标系中的状态方程表示为:ηRV‑CA(k+1)=ΦRV‑CA(k)ηRV‑CA(k)+ΓRV‑CA(k)ωRV‑CA(k);
式中, 表示k时刻目标的状态,T为多
普勒雷达采样时间间隔,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度, 分别为角加速度和径向加速度;
代表r(k), 之间的协方差, 代表 的方差,ΦRV‑CA(k)为状态转移矩阵,ΓRV‑CA(k)为过程噪声驱动矩阵,ωRV‑CA(k)为过程噪声。
4.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,多普勒雷达位置位于极坐标系坐标原点,所述多普勒雷达测量的方程具体表示为:Zm(k)=f(X(k))+Vm(k);
θ(k)=arctan(y(k)x(k));
式中,θm(k)、rm(k)和 分别为方位角量测、距离量测和多普勒量测;θ(k)、r(k)和分别为方位角量测真实值、距离量测真实值和多普勒量测真实值; 和分别为方位角量测噪声、距离量测噪声和多普勒量测噪声,均为零均值高斯白噪声,方差分别为 和 (σθ、σr和 为其对应标准差),且 和 不相关, 和 不相关,和 的相关系数为ρ,即有
5.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,所述步骤2具体包括:已知三维随机向量的均值和方差,经sigma点采样后代入非线性函数f(·),再经加权和求取极坐标下过程噪声 和 的统计特性;
匀速直线运动模型和匀加速直线运动模型求取均值和协方差过程的具体步骤为:(1)根据sigma点采样规则,由三维随机向量的均值和方差,生成2n+1个3维样本点;
(2)计算(1)中非线性函数变换产生的样本点;
(3)确定各个三维样本点均值和协方差的权值;
(4)基于(3)中获得的权值,确定映射的均值和方差阵。
6.根据权利要求5所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,在匀速直线运动模型和匀加速直线运动模型中所述非线性函数f(·)为:其中, 和 是匀速直线运动模型切向过程噪声和径向过程噪声; 和 是匀加速直线运动模型切向过程噪声和径向过程噪声; 和 是匀速直线运动模型X和Y方向上的零均值高斯白噪声; 和 是匀加速直线运动模型X和Y方向上的零均值高斯白噪声;θ(k)为服从正态分布的随机变量。
7.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,进行状态初始化的具体过程为:(1)当模型为匀速直线运动时,根据笛卡尔坐标系下初始目标状态的均值s(0)和协方差S(0),随机生成N个四维样本点 j=1,2,3…N;模型为匀加速直线运动时,根据笛卡尔坐标系下初始目标状态的均值b(0)和协方差B(0),随机生成N个六维样本点 xj和yj是随机样本点的位置,和 是随机样本点的速度, 和 是随机样本点的加速度;
(2)计算极坐标中每个状态点的值ηj;
(3)计算极坐标中状态点的均值和协方差;
8.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,在匀速直线运动模型下计算极坐标中每个状态点的值的公式为:θj=arctan(yjxj);
在匀加速直线运动模型下计算极坐标中每个状态点的值的公式为:θj=arctan(yj/xj);
9.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,对目标状态和协方差一步预测的具体公式为:η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k);
T T
P(k+1,k)=Φ(k)P(k,k)Φ(k) +Γ(k)Q(k)Γ(K) ;
式中,η(k+1,k)和P(k+1,k)分别为k时刻预测的目标状态和协方差,Q(k)为过程噪声协方差矩阵。
10.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,所述通过最小方差线性融合完成当前时刻目标跟踪状态和协方差更新的具体步骤为:‑1 ‑1
η(k+1,k+1)=P(k+1,k+1)[P(k+1,k) η(k+1,k)+Pz(k+1,k+1) ηz(k+1,k)];
‑1 ‑1 ‑1
P(k+1,k+1)=[P(k+1,k) +Pz(k+1,k+1) ] ;
在计算中,对观测矢量及其协方差扩维并对缺损元素置零,以适于实施矩阵运算;
其中,当模型为匀速直线运动时,
当 模型 为 匀 加 速 直 线运 动 时 ,