[发明专利]一种具有最优运动模式切换参数的交互式多模型目标跟踪方法

摘要

本发明属于机动目标跟踪的技术领域，具体涉及一种具有最优运动模式切换参数的交互式多模型目标跟踪方法。本发明包括计算最优的运动模式切换参数；利用运动模式切换参数计算各个运动模式的最优交互概率；利用最优交互概率计算得到每一个运动模式所对应滤波器的初始化信息；将传感器获得机动目标的速度、位置的测量信息和初始化信息输入到滤波器中进行信息处理，得到各个运动模式下的目标位置、速度和跟踪误差协方差，并求取各个运动模式的似然函数；进行运动模式概率更新；得到最终的目标位置、速度信息和跟踪误差协方差。本发明避免了传统交互式多模型目标跟踪方法将相关性信息遗漏的问题。

主权项

一种具有最优运动模式切换参数的交互式多模型目标跟踪方法,其特征在于：(1)利用上一时刻每一个目标运动模式概率和目标位置、速度跟踪误差协方差信息，计算最优的运动模式切换参数；(2)利用步骤(1)中的运动模式切换参数计算各个运动模式的最优交互概率；利用最优交互概率计算得到每一个运动模式所对应滤波器的初始化信息；(3)将传感器获得机动目标的速度、位置的测量信息和步骤(2)中的初始化信息输入到滤波器中进行信息处理，得到各个运动模式下的目标位置、速度和跟踪误差协方差，并求取各个运动模式的似然函数；(4)利用步骤(3)中求取的运动模式似然函数进行运动模式概率更新；(5)将步骤(3)中得到的各个运动模式下的目标位置、速度信息和跟踪误差协方差与步骤(4)中的运动模式概率进行加权求和，得到最终的目标位置、速度信息和跟踪误差协方差；所述步骤(1)为：令运动模式切换参数为π，元素πij(k‑1)为运动模式传递概率，交互概率为μi|j(k‑1)，运动模式概率为μj(k‑1)；为第j个运动模式的状态xj(k‑1)的估计值，为第j个运动模式滤波器的交互初值x0j(k‑1)的估计值，x0j(k‑1)即为运动状态的真实值x(k‑1)；第j个运动模式滤波器的交互初值误差和跟踪误差分别定义为：x~0j(k-1)=x(k-1)-x^0j(k-1),]]>x~j(k-1)=xj(k-1)-x^j(k-1),]]>第j个运动模式滤波器的最优交互初值为：x^0j(k-1)=Σi=1nμi|j(k-1)x^i(k-1),]]>x(k-1)=Σi=1nμi|j(k-1)xi(k-1),]]>交互概率为：μ1|j(k‑1)+μ2|j(k‑1)+…+μn|j(k‑1)＝1，x~0j(k-1)=Σi=1nμi|j(k-1)xi(k-1)-Σi=1nμi|j(k-1)x^i(k-1)=Σi=1nμi|j(k-1)x~i(k-1)=βjT(k-1)X~(k-1),]]>其中，X~(k-1)=x~1T(k-1)x~2T(k-1)...x~nT(k-1)T,]]>βj(k‑1)＝[μ1|j(k‑1) μ2|j(k‑1) … μn|j(k‑1)]T，βjT(k-1)e=1]]>其中e＝[1 1 … 1]T；的协方差为：P~0j(k)=E[x~0j(k)x~0jT(k)]=βjT(k)E[X~(k-1)X~T(k-1)]βj(k-1)=βjT(k-1)P~(k-1)βj(k-1),]]>其中，E[·]表示对矩阵求期望值，P~(k-1)=P~11(k-1)P~12(k-1)...P~1n(k-1)P~21(k-1)P~22(k-1)...P~2n(k-1)............P~n1(k-1)P~n2(k-1)...P~nn(k-1),P~ij(k-1)=E[x~i(k-1)x~jT(k-1)];]]>跟踪误差协方差是衡量状态估计精度的，越小，为了得到最优的πij(k‑1)，将性能指标设定为：J=tr(P~0j),]]>其中tr(·)表示对各个分块矩阵求迹；B(k-1)=tr(P~11(k-1))tr(P~12(k-1))...tr(P~1n(k-1))tr(P~21(k-1))tr(P~22(k-1))...tr(P~2n(k-1))............tr(P~n1(k-1))tr(P~n2(k-1))...tr(P~nn(k-1)),]]>则性能指标为：J=βjT(k-1)B(k-1)βj(k-1),]]>引入拉格朗日算子λ，构建辅助函数F：F=J+2λ(βjT(k-1)e-1),]]>∂F∂βj(k-1)|βj(k-1)=βjopt(k-1)=0,]]>B(k-1)βjopt(k-1)+λe=0,]]>得矩阵方程组：B(k-1)eeT0βjopt(k-1)λ=01,]]>显然，B(k‑1)是一个正定矩阵，则eTB‑1(k‑1)e≠0，那么性能指标函数的最优解为：βjopt(k-1)=B-1(k-1)eeTB-1(k-1)e,]]>μi|j(k-1)=1c‾jπij(k-1)μi(k-1)c‾j=Σi=1nπij(k-1)μi(k-1),]]>解得最优的πij(k‑1)：πijopt(k-1)=Πb≠jnub(k-1)Σa=1naja(k-1)Σd=1n(Πb≠dnub(k-1)Σa=1nada(k-1)),]]>其中，B‑1(k‑1)＝A(k‑1)，由于是在性能指标取得最小值时的最优解，从而构成最优的运动模式切换参数πopt。