发明内容
本发明所要解决的技术是,提供一种利用高精度传感器的量测值对传感器组进行高精度量测值构建的方法。
本发明为解决上述技术问题所采用的技术方案是,一种多传感器管理中构建虚拟量测值的方法,包括以下步骤:
1)计算第k时刻对跟踪目标进行探测的待处理传感器组内普通传感器的探测值均值 n为普通传感器总数,zik表示第k时刻第i个普通传感器的探测值,i=1,2,..,n;
2)计算各普通传感器的探测值zik与探测值均值的距离△ik:然后根据绝对值大小排序,调整探测值zik的排列顺序;
3)求取探测值均值与各普通传感器的探测值的无偏方差估计QVi:
4)以无偏方差估计QVi为方差,利用距离△ik进行伪高斯处理,得到修正值:
i=1,2,..,n,Max表示取最大值;
5)将k时刻各普通传感器探测值修正为:i=1,2,..,n;
6)将k时刻普通传感器的探测值表示为高斯粒子群形式:
7)计算k时刻各普通传感器对应的权重为:i=1,2,..,n;为上一时刻k-1时第i个普通传感器的权重,权重初值为1/n,概率密度函数p(zi0|z'ik)服从高斯分布,zi0为高精度传感器的探测值,exp为以自然对数e为底的指数函数;
8)得到k时刻待处理传感器组内的虚拟值量测
上述方法中高精度传感器包含在带处理的传感器组内,基于同样的思想,下面提供一种利用某含高精度传感器的传感器组为其他不含高精度传感器的传感器组构建虚拟量测值得方法。
一种多传感器管理中构建虚拟量测值的方法,包括以下步骤:
1)组内量测修正值计算步骤:
1-1)计算第k时刻对跟踪目标进行探测的待处理传感器组内普通传感器的探测值均值n为普通传感器总数,zik表示第k时刻第j个普通传感器的探测值,j=1,2,..,n;所述待处理传感器组内全部为普通传感器;
1-2)计算各普通传感器的探测值zjk与探测值均值的距离△jk:然后根据绝对值大小排序,调整探测值zjk的排列顺序;
1-3)求取探测值均值与各普通传感器的探测值的无偏方差估计QVi:
1-4)以无偏方差估计QVj为方差,利用距离△jk进行伪高斯处理,得到修正值:
j=1,2,..,n,Max表示取最大值;
1-5)将k时刻各普通传感器探测值修正为:j=1,2,..,n;
2)组外量测修正值计算步骤:
2-1)计算第k时刻对跟踪目标进行探测的高精度传感器所在的传感器组中的普通传感器的探测值均值 n为普通传感器总数,zik表示第k时刻第i个普通传感器的探测值,i=1,2,..,n;所述待处理传感器组内的普通传感器的数量与包含有高精度传感器的传感器组中的普通传感器的数量相同;
2-2)计算高精度传感器所在的传感器组中各普通传感器的探测值zik与探测值均值的距离△ik:
2-3)求取高精度传感器所在的传感器组中探测值均值与各普通传感器的探测值的无偏方差估计QVi:
2-4)以无偏方差估计QVi为方差,利用距离△ik进行伪高斯处理,得到高精度传感器所在的传感器组中修正值:i=1,2,..,n,Max表示取最大值;
2-5)将k时刻高精度传感器所在的传感器组中各普通传感器探测值修正为:i=1,2,..,n;
3)虚拟量测值计算步骤:
3-1)计算k时刻各普通传感器对应的权重为:j=1,2,..,n,i=1,2,..,n;为上一时刻k-1时待处理传感器组内第j个普通传感器的权重,权重初值为1/n,概率密度函数p(zi0|z'ik)服从高斯分布,zi0为待处理传感器组外的高精度传感器的探测值,exp为以自然对数e为底的指数函数;
8)得到k时刻待处理传感器组内的虚拟量测值
本发明的有益效果是,将一系列进过预处理的低精度传感器获得的量测值作为服从高斯分布的弱粒子集,与高精度传感器获得的量测值计算获得一系列权值,然后进行最小均方估计,获得一个远高于低精度量测值次于高精度量测值的虚拟值。这样将该高精度量测值的虚拟值加入分布式融合算法中进行滤波跟踪可进一步提高探测跟踪效果。
具体实施方式
粒子滤波是一种基于蒙特卡洛方法和递推贝叶斯估计的统计滤波方法,根据系统状态的经验分布产生一组随机样本粒子集,然后根据量测不断调整粒子的权值和位置。实质是由粒子及其权值来近似系统后验概率分布。本发明利用粒子滤波的思想,将低精度探测数据处理后作为粒子集,与高精度探测数据计算出一系列权值,然后进行最小均方估计,虚拟出次高精度的量测值用于分布式融合计算。仿真结果显示此方法可以一定程度上提高系统的整体跟踪效果:
采用离子滤波思想产生虚拟探测值的具体方法如下:
1.由组内高精度量测值产生虚拟探测值,即在包含高精度传感器的传感器组内,利用高精度探测值构建一个次高精度虚拟探测值得方法:
1)产生粒子集
假设k时刻依据传感器分配方法已获得最优传感器分配方案,其中传感器组Mi分配用以探测跟踪目标T,包含高精度传感器mi0和普通低精度传感器mi1,mi2,...,min;k时刻获得所有传感器对目标T1的探测值zi0,zi1,zi2,...,zin,n为组内普通传感器总数。
首先求取低精度探测值得平均值:
计算各探测值与均值的距离:
求取基于均值与各低精度探测值的无偏方差估计:
以无偏方差估计QVi为方差,均值为0,利用探测值与均值的欧式距离进行伪高斯处理,令
则传感器探测值转换为:
经过以上处理,k时刻低精度传感器的探测值可用如下概率密度表示成的高斯粒子群形式,其中N表示高斯部分函数,为均值、Qvi为方差:
2).权系数确定
根据粒子滤波的知识,已知动态系统的状态先验条件概率p(x0),利用描述k时刻目标状态xk的后验概率分布p(x0:k|z1:k),z1:k为1至k时刻的探测值,x0:k为0至k时刻的目标状态,是对应权值的粒子集。权值被归一化,则k时刻目标状态的后验概率分布可离散地加权为:
其中,δ为冲击函数,权值通过重要采样法产生。弱粒子集可由重要密度函数q(x0:k|z1:k)得到,则权值为:
∝为证明符号
后验概率密度可表示为:
选择先验概率密度作为重要密度函数,权值公式更新为:
将进过伪高斯处理的低精度传感器获得的探测值z'ik作为粒子集,高精度传感器获得的探测值zi0作为探测值进行最小均方估计。因为假设所有传感器的探测误差值都是零均值的高斯噪声,因此以作为先验概率密度,作为重要密度函数,根据以上可获得权重计算公式为:
即
为上一时刻k-1时第i个普通传感器的权重,权重初值为1/n,概率密度函数p(zi0|z'ik)服从高斯分布,zi0为组内高精度传感器的探测值,当待处理传感器组有2个以上的高精度传感器时,zi0为组内精度最高的高精度传感器的探测值,exp为以自然对数e为底的指数函数。
3)获得虚拟量测值
粒子集:{z'ik,i=1,2,...,n},权值:则虚拟值估计为:
通过传感器组内一步预测xk|k-1计算虚拟量测值的虚拟量测方差:
2.传感器组外需求产生虚拟探测值,即利用某含高精度传感器的传感器组为其他不含高精度传感器的传感器组构建虚拟量测值得方法:
1)产生粒子集
最优传感器分配方案中,传感器组Mj分配用以探测跟踪目标T2,(j≠i),只包含普通低精度传感器mj1,mj2,...,mjn且数目与包含高精度传感器的传感器组Mi相同。
公式(14)-(17)针对传感器组Mj:
求取低精度探测值得平均值:
计算各探测值与均值的距离:
求取基于均值与各低精度探测值的无偏方差估计:
以无偏方差估计QVj为方差,均值为0,利用探测值与均值的欧式距离进行伪高斯处理,检测所有两个传感器组内传感器数量,使用以均值和无偏方差估计构成的分布中随机抽样值做填充,是数量匹配。令
公式(18)-(19)针对传感器组Mi:
在高精度传感器组内求取低精度探测值得平均值,此探测值可能是此传感器组对其他任意目标进行探测获得的,同式(1):
则高精度传感器组内探测值转换为修正值,同式(5):
同时低精度传感器组内探测值转换为:
选择先验概率密度作为重要密度函数,权值公式更新为:
即
当高精度传感器所在的传感器组中有2个以上的高精度传感器时,zi0为组内精度最高的高精度传感器的探测值。
粒子集:{z'jk,j=1,2,...,n},权值:则虚拟值估计为:
无偏方差估计为:
对所有未含有高精度传感器的传感器组进行如上操作,全部产生次高精度探测值后进行分布式融合算法计算,获得所有目标的更新值,然后释放所有数据,根据所采用的传感器管理方法进行传感器分配,进行下一时刻的滤波,重复以上过程。
仿真验证
仿真1:设传感器组A,含传感器[GA1,GA2,GA3,GA4],对应探测噪声误差方差为[5,16,17,18],构造虚拟量测值。传感器GA1为高精度传感器,GA2,GA3,GA4为普通传感器。使用本发明方法由组内高精度量测值产生虚拟探测值,进行100次蒙特卡洛仿真,各量测值、虚拟值与真实值的误差如图1所示:其中上面的直线表示GA2,GA3,GA4与真实值之间的误差,下面的点线为GA1与真实值之间的误差,虚线为虚拟值与真实值之间的误差。仿真可见虚拟值的精度比低精度量测值提高幅度较大,接近于高精度量测值。
仿真2:设传感器组A,含传感器[GA1,GA2,GA3,GA4],对应探测噪声误差方差为[5,16,17,18],传感器GA1为高精度传感器,GA2,GA3,GA4为普通传感器。设传感器组B,含传感器[GB1,GB2,GB3],对应探测噪声误差方差为[15,18,17],GB1,GB2,GB3为普通传感器。使用本发明方法由组外高精度量测值产生虚拟探测值。进行100次蒙特卡洛仿真,各量测值及虚拟值与真实值的误差如图2所示:其中直线表示GB1,GB2,GB3与真实值之间的误差,虚线为虚拟值与真实值之间的误差。仿真可见虚拟值的精度比低精度量测值稍有提升,但没有同一传感器组内那么明显。
仿真3:设传感器组A,含传感器[GA1,GA2,GA3,GA4],传感器GA1为高精度传感器,GA2,GA3,GA4为普通传感器,对目标I的探测噪声误差方差为[5,16,17,18],一段时间内获取对目标I的探测值,进行跟踪滤波。使用产生虚拟值的方法进行对比仿真。图3(b)为传感器GA1,GA2,GA3,GA4在250个时刻内对目标I进行跟踪滤波后,与真实航迹的误差值,图3(a)为产生虚拟值替换GA4进行跟踪滤波后,与真实航迹的误差值。仿真结果可以看出使用虚拟值替换了噪声误差最大的探测值后滤波精度提高。