第七讲目标跟踪算法【第一版】

多源信息融合处理技术主讲人：李玉柏[e-mail]第七讲：目标动态模型与目标跟踪目标跟踪基本概念坐标系与跟踪门模型目标的动态模型基本的目标跟踪算法量测模型的线性化处理量测坐标转换基于BLUE的Kalman滤波算法1、目标跟踪基本概念目标跟踪是指为了维持对目标当前状态的不断估计，同时，也是对传感器接不断收到的量测进行处理的过程。目标状态包括：–运动学分量，如目标的位置、速度。–其他特性分量：有辐射的信号强度，谱特性，“属性”信息等。–常数或其他缓变参数：精合系数，传播速度等。1）目标跟踪基本概念目标跟踪是一个典型的不确定性问题，并随着监视和反监视技术发展和目标机动性提高，使得目标跟踪问题的不确定性更加严重。跟踪问题的不确定性主要来源：–目标运动状态的不确定性-过程噪声–量测(信息)源的不确定性-观测噪声–多目标和密集杂回波环境造成量测数据模糊-虚假噪声。目标跟踪本质是通过滤波，对目标运动状态进行估计和预测，来消除目标相关的不确定性。目标跟踪基本概念目标跟踪处理过程所关注的量测通常不是原始的观测数据，而是信号处理子系统或者检测子系统的输出信号。包括：–直接的位置估计、斜距、方位角信息–多传感器的抵达时间差–由于Doppler频移导致的多传感器间的观测频差等。航迹(Track)是目标跟踪领域经常提到的概念，它是指基于源于同一目标的一组量测信息获得的目标状态轨迹的估值，本质上就是目标跟踪滤波结果。2）单目标跟踪基本原理框图单机动目标跟踪是目标跟踪的基础。其基本要素包括量测数据形成，目标机动模型，自适应滤波与预测以及跟踪坐标系和滤波状态的选取。单机动目标跟踪本质上就是一个递推滤波过程。首先，由传感器获得目标的量测数据；通过量测模型获得量测数据与目标位置的关系函数，将此与目标的当前状态一起作为输入；由跟踪滤波器结合机动目标模型得到当前目标状态的估计值和预测值，并把得到的状态作为下一时刻的初始状态，从而完成单机动目标跟踪过程。单目标跟踪基本原理框图111ˆˆkkkkkkkkxxGz目标跟踪基本原理框图图中假定目标动态特性用包含位置、速度和加速度的状态向量X表示，量测量用Z表示，新息向量用表示。1kkz1kkz1kkz–首先先由量测量Z和状态预测量计算残差（新息）向量;–然后根据的变化进行机动检测或机动辨识;–其次按照某一准则或逻辑调整滤波增益与协方差矩阵或者实时辨识出目标机动特性；–最后由滤波算法得到目标的估计值和预测值，从而完成目标跟踪功能。3）多目标跟踪基本原理多机动目标跟踪是指在多量测数据的情况下，利用跟踪滤波和数据关联算法对多个机动目标进行状态估计和跟踪的算法。多机动目标跟踪不仅包括单机动目标的基本要素，还形成一些新的要素，主要包括跟踪门规则，数据关联和跟踪维持等。其中数据关联是多机动目标跟踪的核心。多机动目标跟踪的基本框架如下图所示。多目标跟踪基本原理2、坐标系与跟踪门任何目标的运动描述和跟踪问题都是相对于某一特定的坐标系而言的，是几种常见的有下面几种坐标系：–惯性坐标系：原点选在地球球心，定义X，Y，Z三坐标轴互相垂直并且各自指向某相应的恒天体，例如令Z指向北极星。–地理坐标系：也叫NED坐标系，原点设在载机质心上，N指向北，E指向东，D方向垂直地平面并指向地心。除了在北极附近外，地理坐标系可近似看作一个惯性坐标系，因为载机的移动造成各轴方向的变化很小，可以忽略不计。1）各种坐标系–载机坐标系：也叫机体坐标系，或观测坐标系。原点设在载机质心上，X轴为载机纵轴机头方向，Y轴为右机翼正向，Z轴由右手螺旋定则确定，并朝下。–方向余弦坐标系：是由于相控阵雷达的应用而引入的。相控阵雷达一般采用方向余弦坐标系给出观测值z=[R，cosα，cosβ]T，其中R是原点到目标的径向距离，α/β分别是目标径向与X，Y轴的夹角。上述前三种坐标系属于直角坐标系，方向余弦坐标系属于球面坐标系。各种坐标系通常探测器的量测信息是在球面坐标系中进行的，但是运动目标的状态方程在直角坐标系中可以线性地表示。如果在一种坐标系中建立目标的状态方程，要么状态方程线性，观测（量测）方程非线性；要么状态方程非线性，观测方程线性。–前面我们介绍了量测信息的坐标系转换。2）跟踪门跟踪门是整个跟踪空域中的一块子区域，它将传感器接收到的量测信号划分为可能源于目标和不可能源于目标的两个部分。其中心位于被跟踪目标的预测位置，大小由接收正确量测信号的概率来确定。跟踪门的功能是将落入跟踪门内的量测信号称为候选信号。–在数据关联过程中，如果只有一个量测信号落入该目标的跟踪门内，则此量测直接用于航迹更新；跟踪门基本概念–如果多于一个以上的量测信号落在被跟踪目标的跟踪门内，那么通过跟踪门逻辑可以粗略确定用于航迹更新的量测信号集合。–然后通过更高级的数据关联技术，以最终确定用于目标航迹更新的量测信号。1ˆkkx1ˆkkz定义：滤波残差，是考虑一个处于跟踪维持阶段的目标（已经初始化），设k-1时刻状态变量的滤波预报值为，通过观测方程可以求出k时刻量测的预报值，它与k时刻量测信号之差为滤波残差向量。跟踪门基本概念11ˆ~kkkkkzzz滤波残差：注意：如果我们把目标跟踪看成动态参数估计，滤波残差就是前面讲的“新息(innovation)”。11ˆˆkkkkkxzH其中：kkkkvxzH已知：定义：残差协方差阵SkTkkkkkHPHS1定义：1112~~kkkTkkkzzdS定义：残差向量范数2kd典型跟踪门,1,1,11ˆˆ,,,,kikkkikkikkkkzzzzzzi的第个分量矩形跟踪门：–最简单的跟踪门形成方法是在跟踪空间内定义一个矩形区域，即矩形跟踪门。–定义各种向量的分量：–定义跟踪门常数为KG。它取决于观测概率密度，检测概率以及状态矢量的维数。–如果观测量zk满足：则称zk为候选量测信号。这里i为第i个残差的标准偏差。,1,1.ˆdefkiGikkikkizzzK典型跟踪门椭球跟踪门：–设为椭球跟踪门的门限大小，如量测信号zk满足：–则称zk为候选量测信号。2kd其他跟踪门：除了前面提到的两种常见的跟踪门外，还有球面坐标系下的扇形跟踪门，以及基于数据关联性能评价的优化跟踪门算法等。–在实际的多目标跟踪问题中，跟踪门的使用非常广泛。当目标无机动时，跟踪门的大小一般为常值；当目标机动时，调整门的大小以保证一定的接收正确回波的概率就成了关键问题。3、目标动态模型大多数机动目标跟踪问题都是基于模型的。也就是说，依赖于两个描述：一是目标行为，通常用动态运动模型表示；另一个是对目标的观测，称为观测模型。目标跟踪的数学模型目标跟踪的主要目的就是估计移动目标的状态轨迹。虽然目标在空间上几乎从来不是一个真正的点，且其方向信息对于跟踪也是有用的，但通常还是把目标看作空间没有形状的一个点，特别对于目标建模更是如此。目标动态模型描述了目标状态又随时间的演化过程。1）目标跟踪的数学模型几乎所有的运动目标跟踪方法都是基于模型的。常用的状态空间模型为：1(,)()()kkkkkkkkkkxfxuΓwzhxvkN注意：同前面介绍的动态系统方程描述多了一个控制输入变量u(t)，用以表示目标机动时外力作用的输入。离散时间模型()[(),()][()]()[()]()kkkkkxtfxtutwtzthxtvt目标跟踪的数学模型对于目标跟踪挑战之一是目标运动模式的不确定性，即被跟踪目标的精确动态模型是不知道的。跟踪者不知道目标实际的控制输入u，也不知道动态模型的具体形式和相关参数。为此可以针对机动和非机动两种模型进行研究。非机动运动是指在惯性参考坐标系中，目标按某个定常的速度作直线和水平运动。广义地讲，所有不是机动运动的模式都叫非机动。1kkkkkkkkkkkxFxEuGwzHxvkN通常我们处理时线性系统，此时离散时间模型目标跟踪的数学模型–白噪声模型，假设控制输入u为白噪声，包括常速CV模型，常加速CA模型和多项式模型等；–Morkov过程模型，假设控制输入u为Morkov过程，包括Singer模型及其变形；–半Morkov过程模型，假设控制输入u为半Morkov过程。非机动目标跟踪中，目标的控制输入u等于零。而在有机动目标跟踪中，对目标的控制输入u通常可以假设为未知加速度，它决定了机动的数学模型，具体应用中可以分为：2）非机动模型—常速CV模式在三维物理空间的点目标运动，可以用三维的位移和速度向量来描述：非机动目标的动态模型一般可描述为：(,,)(,,)(,,,,,)Txyzxyzxxyyzzx位移向量：速度向量：目标状态：10,0010)(],,[)(],,[)(CVCVCVCVCVCVCVCVAtdiagtAAAdiagtwxx非机动模型—常速CV模式离散化模型（T采样间隔）TTGTFGGGdiagFFFdiagCVCVkCVCVCVkCVCVCVk2211,101],,[],,[wxxykkkykkkkwTyyywTyTyyy,1,2211方向速度：方向位移：具体给出一个状态分量（y方向）的具体表达式：非机动模型—常速CV模式噪声协方差为：32,,2cov()[,,]/3/2/2xyzk各＝wk其中代表w分量方差,特别说明在一般飞行器的常速模型分析中，主要研究水平机动，有时允许z方向速度有机动，此时方程：代表速度扰动zkzkkkwwTzz,,1–请同学写出这种情况下完整的常数模型方程！！3）目标机动模型—白噪声加速度模式最简单的目标机动模型—白噪声加速度模式具体离散表达式为：zyxwzwywx,,加速度：TTETFEEEdiagFFFdiagkkk2211,101],,[],,[wxx–本质上与CV模型类似。只不过体现加速度的随机扰动是输入控制量产生的，因此随机扰动方差较大，CV模型的加速度随机扰动方差很小。4）Wiener过程加速度机动模型假设加速度是一个Wiener过程，即独立增量随机过程，简称常加速CA模型。令状态变量：[,,,,,,,,]()[,,][,,]()0100001,00001TxxxyyyzzztdiagFFFdiagEEEtFExxxwcov(()())wQttT过程加速度机动模型具体离散表达式为：1[,,][,,]()kkkkkdiagFFFdiagEEEtkkkkxxw023()20()()1/2/601,/2001TTATATkkkkTdTTTFeTEeEdTTkww其中：54343232cov(,,)/20/8/6/8/3/2/6/2其中5）一般多项式模型众所周知，任何连续目标轨迹都可以用某个阶次的多项式以任意精度逼近。这样，可以把目标运动建成笛卡儿坐标系中的n阶多项式模型：1111()()()()()()()/!onxonyonznxtaaawtttytbbbwtztcccwttnx说明：这个模型作为跟踪模型很少采用，其原因是这个模型需要一组数据进行拟合，即进行平滑，而跟踪的目的是滤波和预测，并不是拟合与平滑。6）Singer加速度模型——零均值一阶Markov模型在随机建模中，一个未知的时变量则可用随机过程来描述，白噪声构成最简单的一类随机过程，对于连续变量就是独立增量过程或Wiener过程。()at