本发明涉及图像、雷达及声纳信号处理领域。
背景技术:
目标跟踪是用信号处理的方法对图像、雷达、声纳等应用场合中存在的目标状态信息进行估计,广泛应用在雷达及视频跟踪、无线激光通信、天文观测、航空摄影等领域。
在目标跟踪系统中,对目标的观测信号进行传输、处理会造成目标信息的观测滞后,同时控制系统通过执行机构对移动目标动态跟踪时,会有一定的控制滞后。在很多情况下,噪声对目标跟踪效果的影响远远小于观测和控制滞后对整个跟踪系统的影响。如果能够超前预测目标的运动状态,就可以为跟踪控制系统提前提供目标状态预测值,控制系统可提前动作克服跟踪的滞后。当目标受到遮挡时,跟踪系统可以按照超前预测值维持对目标的连续跟踪。
现有的运动目标跟踪方法一般都是在取得目标运动状态观测值的情况下,应用滤波方法得到状态的最优估计值,滤波的目的主要是为了克服干扰噪声的影响,但却无法克服跟踪的滞后。当滤波用于目标状态预测跟踪时,预测精度依赖于干扰噪声的分布,且一步预测精度有限,无法满足预测跟踪的精度要求。
技术实现要素:
本发明提供一种目标超前预测跟踪方法,在观测噪声影响不大的情况下,可提前一步预测目标的运动状态,实现目标状态的超前一步预测。首先对运动目标建立运动模型,然后采用平方根容积卡尔曼滤波的方法对目标下一时刻的运动状态做出超前一步预测,即先验估计,通过统计当前时刻之前的先验预测值与观测值之间的误差序列,建立马尔科夫转移概率模型,由马尔科夫转移概率矩阵预测下一时刻的先验预测误差,并用此误差修正下一时刻的目标状态预测值。本发明的超前预测跟踪方法能提前一步预测目标的运动状态,为跟踪控制系统提前提供目标状态预测值,控制系统可提前动作克服跟踪的滞后。当目标受到遮挡时,跟踪系统可以按照超前预测值维持对目标的连续跟踪。
为实现上述目的,本发明一种目标超前预测跟踪方法,具体步骤为:
步骤一,建立目标的运动模型和观测模型,
步骤二,用平方根容积卡尔曼滤波超前预测目标的位置状态,具体过程如下:
设定k-1时刻后验概率
构建容积点:
传播容积点:
先验状态预测
预测误差协方差阵平方根系数
估计容积点
传播容积点zi,k|k-1=h(xi,k|k-1),i=1,2,...,m;
计算测量预测值
新息协方差阵平方根系数
互协方差阵
增益计算
最优状态估计
估计误差协方差阵平方根系数
步骤三,用马尔科夫预测模型修正超前预测值,具体过程如下:
由步骤二取k时刻及之前的l+1个先验状态预测值
令δmin=min{δk-l-1,δk-l,…δk-1}且δmax=max{δk-l-1,δk-l,…δk-1},将[δmin,δmax]范围分成n个区间,每个区间对应一个离散的状态,记作{e1,e2,…,en};
根据{e1,e2,…,en},由马尔科夫模型得到转移概率矩阵p(k),根据转移概率矩阵,计算δk最可能处于的状态区间ej,ej区间的中心点作为马尔科夫估计值δk;
步骤四,最终的目标位置一步超前预测值由平方根容积卡尔曼滤波先验估计值和马尔科夫预测值之和确定,即ψ(xk)=ψ(xk)+δk。
具体实施方式
为了进一步说明本发明的技术方案,下面对本发明进行详细的说明,但不是对本发明的限定。本发明一种目标超前预测跟踪方法,具体包括以下步骤:
步骤一,建立目标的运动模型和观测模型,
步骤二,用平方根容积卡尔曼滤波超前预测目标的位置状态,具体过程如下:
设定k-1时刻后验概率
构建容积点:
传播容积点:
先验状态预测
预测误差协方差阵平方根系数
估计容积点
传播容积点zi,k|k-1=h(xi,k|k-1),i=1,2,...,m;
计算测量预测值
新息协方差阵平方根系数
互协方差阵
增益计算
最优状态估计
估计误差协方差阵平方根系数
步骤三,用马尔科夫预测模型修正超前预测值,具体过程如下:
由步骤二取k时刻及之前的l+1个先验状态预测值
令δmin=min{δk-l-1,δk-l,…δk-1}且δmax=max{δk-l-1,δk-l,…δk-1},将[δmin,δmax]范围分成n个区间,每个区间对应一个离散的状态,记作{e1,e2,…,en};
根据{e1,e2,…,en},由马尔科夫模型得到转移概率矩阵p(k),根据转移概率矩阵,计算δk最可能处于的状态区间ej,ej区间的中心点作为马尔科夫估计值δk;
步骤四,最终的目标位置一步超前预测值由平方根容积卡尔曼滤波先验估计值和马尔科夫预测值之和确定,即ψ(xk)=ψ(xk)+δk。
从上述步骤中可以看出,步骤二给出了位置的先验状态预测
综上,本发明给出了一种目标超前预测跟踪方法,可以为跟踪控制系统提前一步提供目标状态预测值,控制系统可提前动作克服跟踪的滞后,并可在目标受到遮挡时按照超前预测值维持对目标的连续跟踪。本发明将可应用于视频、雷达及声纳目标跟踪、机器人定位导航等领域,具有广泛的应用前景。