[0075] 以下结合附图对本发明作进一步说明。
[0076] 本发明提出了一种状态受限移动多传感器配置及多目标跟踪方法,其具体实施方式如下:
[0077] 步骤1.建立系统模型;
[0078] 步骤1.1 建立目标动态模型
[0079] 考虑二维平面内N个移动传感器跟踪M个目标的情形,目标具有如下动态:
[0080]
[0081] 这里, 是目标i的状态向量, 和 分别表示k时刻目标i在x轴和y轴方向上的坐标, 和 表示对应坐标轴上的速度。Ai是目标i的状态转移矩阵,Bi是噪声矩阵, 是服从标准高斯分布的过程噪声,其协方差为
[0082] 步骤1.2 建立传感器模型
[0083] 假定在每一时刻各个传感器的状态都是可观测的,传感器的感知半径足够大,且运动很容易被改变。传感器的动态模型如下:
[0084]
[0085]
[0086] 这里,j=1,2,···,N,N为正整数表示第N个移动传感器。 表示传感器j的位置状态向量, 和 分别表示k时刻传感器j在x轴和y轴方向上的坐标。Fk表示k时刻传感器的状态转移矩阵。Hk+1表示k+1时刻传感器的观测矩阵。 是k+1时刻对传感器j的量测, 和 均是零均值高斯白噪声。
[0087]
[0088]
[0089] 这里,Vj是速度强度输入,是一个正值常数。τk,x,τk,y分别表示传感器在x轴和y轴方向上的速度的方向输入,并且需要满足 方向输入的值只能在 中选取,其中-1和1分别代表着x轴和y轴的负方向和正方向。将传感器瞬时方向输入归类为九个方向即为传感器输入的九个模态。
[0090] 如图1所示,例如, 表示传感器向向右上方移动,(τk,x,τk,y)=(0,-1)表示传感器垂直向下移动。传感器的模式和移动方向的对应关系如表1所示。
[0091] 表1 传感器模式和移动方向对应表
[0092]
[0093] 步骤1.3 建立量测模型
[0094] 表示k时刻用传感器j在输入模态为ρ的情况下对目标i的量测
[0095]
[0096] 其中, 是第j个传感器的观测矩阵, 是零均值、受目标i与传感器j之间距离影响的量测噪声。
[0097] 步骤1.4 建立量测不确定性模型
[0098] 第j个传感器在输入模态为ρ的状态下对目标i量测的不确定性用协方差阵 表示。通常,传感器在测量目标时,往往会受到外界干扰的影响,随着传感器与目标距离的增加,受到的干扰程度就会加重,由此得到的量测噪声协方差就会增大。因此,假定量测噪声协方差 为传感器j与目标i之间距离的函数:
[0099]
[0100] Dk(i,j)=diag([Dk,x(i,j),Dk,y(i,j)]) (8)
[0101]
[0102]
[0103] L=diag([Lx,Ly])
[0104] 这里,Ik是一个单位矩阵,L是常数矩阵,Dk,·(i,j)表示传感器j和目标i的状态差矩阵, 是第j个传感器的常协方差阵,||·||2表示2-范数。该公式表明量测噪声协方差是距离的线性函数。
[0105] 步骤2 标准的制定
[0106] 步骤2.1 目标失检率的表示
[0107] 传感器观测目标的能力很大程度取决于目标与传感器相对状态的变换。用检测概率来表示传感器观测的能力,并且被看作一个领域。这说明目标被观测到的概率不是统一的。为了表示这个领域,我们用钟状函数表示:
[0108]
[0109]
[0110] 其中,dk(i,j)是在k时刻目标i和传感器j的加权马氏距离。PD取[0,1]之间的任一常数。a,b,c都为常数。Sk在k时刻与目标有关的常数矩阵。目标的失检率可以表示为[0111] 图2给出了传感器观测能力分布在坐标系上的函数表示,它形似一个钟形,说明在传感器一定的距离范围内它的观测能力相等,但随着距离增加传感器的观测能力逐渐减弱直至为0。图3给出了传感器失检率,形似倒钟形,在离传感器的一定范围内目标的失检率保持一致,但随着距离增大,目标失检率随之增大直到失检率为1。
[0112] 步骤2.2 标准指标的选择
[0113] 基于确定的最优标准对传感器进行选择和配置。这里,给出一个最优标准的指标:PMD-PaC,它被定义为目标失检率,目标跟踪精度和传感器使用费用的总和,即[0114]
[0115] 该指标也可以用下式表示:
[0116]
[0117] Wk=diag([γk,αk,βk]),Ωk=diag([ωd,ωX,ωb]),
[0118]
[0119] 这里, 表示用第j个传感器在输入模态ρ下观测目标i使用 费用所得到的状态估计。 表示在k时刻用第j个传感器在输入模态ρ下观测目标i的传感器功耗。表示第j个传感器在输入模态ρ下观测目标i时的目标跟踪精度。αk,βk和γk分别表示目标跟踪精度,传感器使用费用和目标失检率的权重系数,权重系数取正值即可,它们与传统的权重系数即在[0,1]区间内取值且相加等于1不同。ωx,ωb和ωd分别表示状态xk,费用bk和传感器与目标距离dk(i,j)的折换系数,因为它们所使用的单位不同。
[0120] 步骤2.3 PMD-PaC系数选择
[0121] 传感器总功耗由传感器对目标的跟踪精度和传感器本身决定。重要性系数αk,βk,γk在步骤2.2中已说明。折算系数wd,wx,wb我们用目标的失检率,目标跟踪精度和费用标准差矩阵的逆来获取,即
[0122]
[0123] 其中, std[·]表示标准差。
[0124] 步骤2.4 指标的计算
[0125] 传感器使用费用是一个常数值,它可以取任意一个正值。因此,我们只要考虑求出目标的失检率和目标跟踪精度。其中目标失检率的表示已经在(9),(10)式中给出,而目标跟踪精度 表示用第j个传感器在输入模态ρ状态下观测第i个目标的估计误差协方差并且可以利用式(1)-(6)进行递归得到:
[0126]
[0127]
[0128]
[0129]
[0130]
[0131]
[0132] 这里, 表示当 时 其中的一个元素 Jk在步骤3中说明。
[0133] 步骤3 传感器的配置
[0134] 用线性规划来描述传感器的配置以及对其模式的选择,即
[0135]
[0136] 这里,Jk表示k时刻用N个传感器对M个目标进行观测的所有传感器的总PMD-PaC的目标函数。 是传感器选择变量, 表示在k时刻选择传感器j的ρ输入模态观测目标i,且 的取值只能是0或1中的一个。
[0137] 然而,只考虑线性规划问题(20),其可以解决传感器选择与跟踪过程的耦合,却不能完全解决传感器模态选择与跟踪过程的耦合,因为当出现一个传感器j同时对多个目标i,i′,i″,i″′,…进行观测时,有可能会出现一个传感器同时工作在多个模态的情况,这是不可能实现的,为此,在线性规划问题(20)获得所有的选择变量 之后,还需要进一步优化。这时采用如下方式来选取:
[0138]
[0139] 其中,{i,i′,i″,i″′,…}表示被传感器j观测到目标的索引集。
[0140] 图4给出了在三个目标、四个传感器情况下,传感器选择配置及多目标跟踪算法流程图。流程图考虑了传感器及其模态的选择问题,然后再依据相应的传感器量测更新目标状态。在这里,首先根据在k-1时刻各个目标的状态估计 获得目标的状态预测在预测步k|k-1之后,分别选择传感器1的 模态观测目标1,选择传感器3的 模态观测目标2和3。然后使用来自这两个传感器的量测
来更新三个目标的状态,获得k时刻的目标状态估计
[0141] 为了更好地阐释说明本发明,在实验中,在x-y平面内设定了四个自由移动传感器、三个匀速转弯运动目标的情景来验证本发明,检测范围为[-1000,1000]×[-1000,1000]m2。
[0142] 四个状态受限移动传感器的初始位置如下:
[0143]
[0144] 在k时刻各个传感器的控制前进输入为 其中V=[V1,V2,V3,V4]T=[15,18,16,15]T。
[0145] 各个传感器的使用费用为:
[0146]
[0147] 三个目标的初始状态及其误差协方差为:
[0148]
[0149]
[0150]
[0151] 目标1,目标2和目标3均做匀速转弯运动,目标运动模型和测量模型中的各个矩阵如下:
[0152]
[0153]
[0154] 这里采样间隔T=1,目标1的转弯角速度为w1=-0.03rad/s,目标2的转弯角速度为w2=0.03rad/s,目标3的转弯角速度为w2=0.01rad/s。目标运动的过程噪声协方差协方差阵 距离常数矩阵为L=diag([150,200])。此外,设定检测区域内杂波密度为λc=1×10-5m-2,即平均有40个杂波点,检测-5
概率PD=0.98,钟状函数的参数a=2000,b=4,c=0,修剪阈值为1×10 ,最大假设个数为
100个,设置重要性系数为αk=1,βk=0.1,γk=5。
[0155] 图5给出的是在0-100s内三个目标的跟踪效果图。其中实线代表目标真实的轨迹,星号线、点画线及加号线代表估计轨迹,虚线代表四个传感器跟踪目标时的运动轨迹。从图中可以看出,传感器能够有效的跟踪目标。并且在图6中能够看出传感器在PMD-PaC准则下,每一个目标通过不同的传感器在移动过程中观测到,并且在图6中可以看出传感器2和4在跟踪的过程中使用的比较频繁,但是传感器1和3却很少使用。
[0156] 图6给出的是在0-100s内,并且将重要性系数改为αk=βk=1的情况下三个目标的跟踪效果图。由于αk=βk=1,这就说明了跟踪精度和传感器使用的费用在跟踪的过程中一样重要。在图7和图8中就可以看出传感器的配置发生了改变,传感器3由于价格昂贵的原因在跟踪的过程中从未被使用。
[0157] 图9给出的是0-100s内,目标在x轴和y轴方向上的速度跟踪估计过程,红线代表目标1,2,3的真实速度值,星号线、点画线及加号线则分别代表目标1,2,3的速度估计值。从x方向和y方向速度估计过程看,本发明可以有效的估计目标速度。
[0158] 图10为移动传感器的模态变化过程,其中纵轴上数值1到9分别代表9个模态如表1所示。例如,从第三幅图中,我们可以看出传感器3在1s-4s中和60s-100s中是静止的。
[0159] 图11给出了自由运动传感器(Moving sensors)和静止传感器(Fixed sensors)跟踪目标时总功耗的对比曲线。由于不同传感器之间的选择变换,曲线呈现出一定的波动性。从图中可以看出,与静止传感器相比,受限移动传感器在跟踪目标的过程中总功耗总是比静止传感器小,稳定性也更好。这说明了自由移动传感器相对静止传感器的优越性和精确性。
[0160] 最后说明,以上描述仅用以说明本发明的技术方案而非限制其所包含范围,即对本发明的技术方案进行修改或者等同替换,而并未脱离其目的和范围的,均应涵盖于本发明的权利要求范围当中。