专利名称：多传感器融合跟踪系统配准偏差在线补偿方法
技术领域：
本发明涉及一种多传感器融合跟踪系统配准偏差在线补偿方法，是航空电子技术、机器人导航系统、空中交通管制系统、多传感器定位系统、数字城市安全保障系统、精确制导系统等领域中的一项核心技术，在各类民用及军用系统中均可有广泛的应用。
针对多传感器融合跟踪系统配准偏差的估计算法，国内外研究人员作了大量的工作，许多研究者采用最小二乘、极大似然估计等统计方法，获得了许多估计配准偏差的有效算法，但是许多估计算法都对误差源和多传感器系统进行了不同程度的近似，并且需要收集大量的测量数据，才能离线获得配准偏差的估计，从而影响系统配准偏差补偿的实时性。在实际系统中，一方面，多传感器可能存在时变的配准偏差，另一方面，配准偏差的补偿和估计希望实现在线性，否则会影响配准偏差补偿的效果。因此深入研究多传感器融合跟踪系统配准偏差在线补偿方法成为多传感器融合跟踪的一个研究热点。
在多传感器融合跟踪系统配准偏差在线补偿算法实现过程中，需要在满足配准偏差估计和补偿精度的前提下，尽量考虑不同误差源和配准偏差估计的实时性，多传感器融合跟踪系统配准偏差在线补偿方法面临的技术难题主要有1.如何综合考虑不同的误差源，对融合跟踪系统的影响；2.出现时变的配准偏差时，如何实现配准偏差的在线估计；3.算法过于依赖历史量测信息，鲁棒性差，难以实现实时处理。
许多研究人员针对多传感器融合跟踪系统配准偏差在线补偿算法提出了一些方法，如递推最小二乘方法、系统状态和配准偏差联合估计的卡尔曼滤波方法等。递推最小二乘方法有效性较低，且只能实现固定配准偏差的估计，系统状态和配准偏差联合估计的卡尔曼滤波方法计算量很大，并且对误差源做了严格的限制，鲁棒性较差。究其原因，主要是没有一种有效的方法能够既处理存在的大多数误差源，又能仅需很少的测量信息，就能实时估计和补偿配准偏差。
为实现这样的目的，本发明的技术方案中，多传感器融合跟踪系统首先由各传感器进行目标探测，获得目标的量测信息。将多传感器的测量信息作为输出，送至目标空间配准模块，实现测量信息的“统一”坐标变换。目标空间配准模块的输出送到多传感器的融合跟踪模块，由多传感器的融合算法和跟踪算法实现目标信息的融合和跟踪。多传感器的融合跟踪模块的输出，一方面送到动态补偿算法中的偏差观测模块，用于配准偏差信息提取。动态补偿算法包含偏差观测、偏差模型、偏差估计和偏差补偿四个子模块。偏差观测模块将提取的有关偏差信息送到偏差模型中，偏差模型包含有针对各种误差源建立的配准偏差模型，配准偏差估计模块根据配准偏差模型和由偏差观测模块送到偏差模型的有关偏差信息，估计系统的配准偏差。配准偏差估计模块的输出送到偏差补偿模块，偏差补偿模块将估计的配准偏差与多传感器的测量信息相加，实现配准偏差的在线补偿；另一方面多传感器的融合跟踪模块的输出，送到跟踪航迹模块，用于后续系统导航或进一步处理。
本发明的方法包括如下具体步骤1.传感器测量信息由各传感器对目标进行量测，获得目标的测量信息，将测量信息送至空间配准模块。
2.空间配准模块传感器测量信息模块的输出送到空间配准模块，空间配准模块同时接受动态补偿算法模块中的偏差补偿模块的补偿输入，实现测量信息的“统一”坐标变换，并将坐标变换结果，送到传感器融合跟踪模块。
3.传感器融合跟踪利用空间配准模块提供的“统一”的测量信息，根据传感器的具体配置，采用加权自适应融合方法和基于“当前”统计模型的跟踪方法实现传感器的融合跟踪。多传感器融合跟踪模块的输出，一方面送到动态补偿算法中的偏差观测模块，用于配准偏差信息提取；另一方面送到跟踪航迹模块，用于后续系统导航或进一步处理。
4.动态补偿算法模块该模块包括偏差观测、偏差模型、偏差估计和偏差补偿等四个模块。偏差观测模块主要功能是依据传感器融合跟踪模块中的量测信息和跟踪信息，提取有关偏差信息，并将偏差观测信息送到偏差模型中，偏差模型模块中中包含有针对各种误差源建立的配准偏差模型，配准偏差估计模块根据配准偏差模型和由偏差观测模块送到偏差模型的有关偏差信息，采用修正的极大似然估计方法和卡尔曼滤波估计系统的配准偏差。配准偏差估计模块的输出送到偏差补偿模块，偏差补偿模块将估计的配准偏差与多传感器的测量信息相加，实现配准偏差的在线补偿。
5.跟踪航迹模块接受传感器融合跟踪模块的输出，可以直接用于显示或保存于航迹文件，也可以用于后续导航系统或火力控制等系统的指令输入。
本发明采用修正的极大似然估计方法确定配准偏差估计的初值，一方面可以降低极大似然估计方法对历史数据的依赖，以便适应配准偏差的在线估计的需要；另一方面，也加快卡尔曼滤波算法滤波算法的收敛过程。同时，该方法在不影响原有融合跟踪系统结构和功能情况下，通过引入多传感器的测量信息和滤波跟踪信息，提取系统偏差信息，实现配准偏差的在线估计和补偿，该算法可以通过硬件并行实现，大大提高了处理速度。本发明在保证原有多传感器融合跟踪系统结构和功能情况下，实现了配准偏差的在线估计和补偿，提高了多传感器融合跟踪系统的探测定位精度和跟踪性能，对于多目标定位跟踪系统而言，采用该算法还可以简化融合跟踪系统中的数据关联及跟踪算法。可广泛应用于航空电子技术、机器人导航、空中交通管制、数字城市安全保障系统、多传感器定位系统等各类民用及军用系统中。
如
图1所示，多传感器融合跟踪系统首先由各传感器进行目标探测，获得目标的量测信息，将多传感器的测量信息作为输出，送至目标空间配准模块，实现测量信息的“统一”坐标变换。目标空间配准模块的输出送到多传感器的融合跟踪模块，由多传感器的融合算法和跟踪算法实现目标的融合和跟踪。多传感器的融合跟踪模块的输出，一方面送到跟踪航迹模块，用于后续系统导航或进一步处理；另一方面送到动态补偿算法中的偏差观测模块，用于配准偏差信息提取。动态补偿算法包含偏差观测、偏差模型、偏差估计和偏差补偿等四个模块。偏差观测模块将提取的有关偏差信息送到偏差模型中，偏差模型包含有针对各种误差源建立的配准偏差模型，配准偏差估计模块根据配准偏差模型和由偏差观测模块送到偏差模型的有关偏差信息，估计系统的配准偏差。配准偏差估计模块的输出送到偏差补偿模块，偏差补偿模块将估计的配准偏差与多传感器的测量信息相加，实现配准偏差的在线补偿。
图1为本发明提出的一种多传感器融合跟踪系统配准偏差的在线补偿方法的总体框图。各部分具体实施细节如下1.传感器测量信息传感器测量信息模块中的各传感器对目标进行量测，获得目标的测量信息，并将测量信息送至传感器空间配准模块。
2.传感器空间配准传感器测量信息模块的输出送到空间配准模块，空间配准模块同时动态补偿算法模块中的偏差补偿模块的补偿输入信息，实现测量信息的“统一”坐标变换，并将坐标变换结果，送到传感器融合跟踪模块。
3.传感器融合跟踪传感器融合跟踪模块利用空间配准模块提供的“统一”的测量信息，根据传感器的具体配置，采用加权自适应融合方法和基于“当前”统计模型跟踪方法实现传感器的融合跟踪，多传感器的融合跟踪模块的输出一方面送到动态补偿算法中的偏差观测模块，用于配准偏差信息提取；另一方面送到跟踪航迹模块，用于后续系统导航或进一步处理。
4.动态补偿算法模块偏差观测模块，依据传感器融合跟踪模块中的量测信息和跟踪信息，提取有关偏差信息，并将偏差观测信息送到偏差模型中。
假设K(K≥2)个传感器，对同一批目标进行量测，令{Δt}表示系统偏差，{St}表示目标的状态观测量，量测值yi，t表示第i个传感器在t时刻的量测值，则
yi，t＝fi(Δt，St)+gi(Δt，St)ni，t(1)其中{ni，t}为标准高斯白噪声序列，{ni，t}，{Δt}，{St}相互独立。将式(1)在(ΔtSt)处进行泰勒级数展开，并略去二阶以上高阶项，整理得yi，t-yi，t≈FS，i，t(St-St)+FΔ，i，t(Δt-Δt)+Gi，tni，t(2)其中yi，t≡fi(Δt，St)，Gi，t≡gi(Δt，St)，(FS,i,t)jk≡∂fij∂Si,k(Z‾t),]]> (FΔi,t)jk≡∂fij∂Δik(Z‾t)]]>Ztτ=[Δtτ,Stτ],]]> τ表示矩阵的转置。
偏差模型模块其中包含有针对各种误差源建立的配准偏差模型，将公式(2)写成如下量测方程形式Δ^tS^t=Δ‾tS‾t+P‾Δ,tPΔS,tPSΔ,tP‾S,tFΔ,i,tτFl,i,tτIEi,t-1vi,t---(3)]]>对于式(3)的卡尔曼滤波器为Δ^t=Δ‾t+KΔ,i,tEi,t-1vi,t---(4)]]>P^Δ,t=PΔ,t-KΔ,i,tEi,t-1KΔ,i,tτ---(5)]]>KΔ,i,t=PΔ,i,tFΔ,i,tτFl,i,tτ+P‾ΔS,t---(6)]]> +PSΔ,tFΔ,i,tτFl,i,tτ+Fl,i,tFΔ,i,tP‾ΔS,t---(7)]]>利用K(K≥2)个传感器可以观测系统偏差，因此有近似式E[Σi=1KCi,t-1vi,t(Δt-Δ‾t)τ|y‾t]≈0---(8)]]>
其中Ci,t≡Fl,i,tGi,tGi,tτFl,i,tτ,]]>代入(2)式并整理得Σi=1KCi,t-1P‾SΔ,t≈-Σi=1KCi,t-1Fl,i,tFΔ,i,tP‾Δ,t---(9)]]>因此PS△,t≈-FtPΔ，t(10)其中F‾t≡(Σi=1KCi,t-1)-1Σi=1K(Ci,t-1Fl,i,tFΔ,i,t)]]>将式(10)代入式(6)、(7)得KΔ，i，t≈PΔ，t[Fl，i，tFΔ，i，t-Ft]τ(11)Ei,t≈Ci,t+P-S,t+Fl,i,tFΔ,i,tP-Δ,tFΔ,i,tτFl,i,tτ]]>-F‾tP‾Δ,tFl,i,tτFl,i,tτ-Fl,i,tFΔ,i,tP‾Δ,tF‾tτ---(12)]]>配准偏差估计模块根据配准偏差模型和由偏差观测模块送到偏差模型的有关偏差信息，估计系统的配准偏差。
为了估计系统偏差，将式(11)代入式(4)、(5)得Δ^t=Δ‾t+P‾Δ,tUi,t---(13)]]>P^Δ,t=P‾Δ,t-P‾Δ,tVi,tP‾Δ,tτ---(14)]]>其中Ui,t≡[Fl,i,tFΔ,i,t-F‾t]τEi,t-1vi,t---(15)]]>Vi,t≡[Fl,i,tFΔ,i,t-F‾t]τEi,t-1[Fl,i,tFΔ,i,t-F‾t]---(16)]]>假定时变配准偏差状态模型可描述为Δt＝aΔt-1+(I-a)E{Δ0}+Wt(17)其中Δ0为t＝0时的系统偏差，wt＝Col{w1，t，wm*K，t}，并且协方差满足Cov{wt}＝Cov{Δ0}+aCov{Δ0}aτ(18)则时变配准偏差的预测方程为Δt＝E{Δt}＝E{aΔt-1+E{Δ0}-aE{Δ0}+wt} 相应的量测修正方程为Δ^t≈Δ‾t+P‾Δ,t[Σi=1KΣui∈(t-l,t]Ui,ui]---(21)]]>P^Δ,t≈P‾Δ,t-P‾Δ,t[Σi=1KΣui∈(t-l,t]Vi,ui]P‾Δ,tτ---(22)]]>其中ui指传感器采样间隔内的某时刻，Ui，t和Vi，t如式(15)、(16)。
为了适应算法的在线性，采用式(23)描述的修正极大似然估计方法确定卡尔曼滤波算法的初值，式(23)描述的性能指标函数只需要很少量的测量数据就能估计偏差，适合于配准偏差的在线估计和补偿。J=Σi,S||yi,s,t-fi,s,t(Si,t,Δi,t)||Fi,s2+||Δt-Δ^||V2---(23)]]>其中‖·‖为矩阵范数，Fi，s是以测量噪声方差为对角线阵的逆矩阵，V是依据传感器先验信息给定的常数矩阵。对所有Si，t，令J/S＝0极小化性能指标函数，再令J/Δ＝0得W=Σi,s(Ais-A~is)τFis(Ais-A~is)---(24)]]>L=Σi,s(Ais-A~is)τFis(dis-d~is)---(25)]]>Δ＝(W+V)-1L (26)其中，Ais=∂fs(S^tΔt)∂Δt|Δ=0.dis=yis-y^is.]]>当采样周期到时，利用式(26)可估计初始的Δ，将估计的Δ0代入式(19)，利用卡尔曼递推算式(19)～(22)就可实时计算出配准偏差。
配准偏差补偿模块利用估计的配准偏差值修正传感器的测量信息，重新作为传感器的测量信息在传感器空间配准模块进行“统一”坐标转换，实现配准偏差的在线补偿。图2(a)表示转换到“统一”坐标系下但未经过在线补偿的同一目标的传感器量测轨迹，左边曲线为雷达测量的目标航迹，右边曲线为红外传感器测量的目标航迹，由于存在配准偏差，使得即使对同一目标多传感器经过坐标变换后，也认为是由雷达和红外分别测量的两个目标的航迹；图2(b)表示转换到“统一”坐标系下并且经过在线补偿后同一目标的传感器量测轨迹。最左边曲线为雷达测量的目标航迹，最右边曲线为红外传感器测量的目标航迹，由于采用配准偏差的在线补偿方法，随着测量数据的增加，配准偏差得到估计和补偿，中间两条曲线经过补偿后也从开始相距较远到逐渐相互接近，直至基本重叠，获得了同一目标的测量航迹。
5.跟踪航迹模块跟踪航迹模块接受传感器融合跟踪模块的输出，可以直接用于显示或保存于航迹文件，也可以用于后续导航系统或火力控制系统的指令输入。
权利要求
1.一种多传感器融合跟踪系统配准偏差在线补偿方法，其特征在于包括如下具体步骤1)传感器测量信息模块中的各传感器对目标进行量测，获得目标的测量信息，并将测量信息送至传感器空间配准模块；2)空间配准模块同时接受传感器测量信息模块的输出信息和动态补偿算法模块中的偏差补偿模块的补偿输入信息，实现测量信息的“统一”坐标变换，并将坐标变换结果，送到传感器融合跟踪模块；3)传感器融合跟踪模块利用空间配准模块输出提供的“统一”的测量信息，根据传感器的具体配置，采用加权自适应融合方法和基于“当前”统计模型跟踪方法实现传感器的融合跟踪，多传感器的融合跟踪模块的输出一方面送到动态补偿算法中的偏差观测模块，用于配准偏差信息提取；另一方面送到跟踪航迹模块，用于后续系统导航或进一步处理；4)动态补偿算法模块包括偏差观测、偏差模型、偏差估计和偏差补偿四个子模块，偏差观测模块依据传感器融合跟踪模块中的量测信息和跟踪信息，提取有关偏差信息，并将偏差观测信息送到偏差模型中，偏差模型模块中包含有针对各种误差源建立的配准偏差模型，配准偏差估计模块根据配准偏差模型和由偏差观测模块送到偏差模型的有关偏差信息，估计系统的配准偏差，配准偏差估计模块的输出送到偏差补偿模块，偏差补偿模块将估计的配准偏差与多传感器的测量信息相加，由传感器空间配准模块实现配准偏差的在线补偿；5)跟踪航迹模块接受传感器融合跟踪模块的输出，可以直接用于显示或保存于航迹文件，也可以用于后续导航系统或火力控制系统的指令输入。
全文摘要
一种多传感器融合跟踪系统配准偏差在线补偿方法，采用修正的极大似然估计方法确定配准偏差估计的初值，可加快卡尔曼滤波算法的收敛过程和在线适应性。通过引入多传感器的测量信息和滤波跟踪信息，提取系统偏差信息，实现配准偏差的在线估计和补偿。本发明在保证原有多传感器融合跟踪系统结构和功能情况下，实现了配准偏差的在线估计和补偿，提高了多传感器融合跟踪系统的探测定位精度和跟踪性能，对于多目标定位跟踪系统而言，采用该算法还可以简化融合跟踪系统中的数据关联及跟踪算法。可广泛应用于航空电子技术、机器人导航、空中交通管制、数字城市安全保障系统、多传感器定位系统等各类民用及军用系统中。
文档编号G01C21/28GK1479081SQ03129699
公开日2004年3月3日 申请日期2003年7月3日 优先权日2003年7月3日
发明者胡士强, 敬忠良 申请人:上海交通大学