![航天器多源信息融合自主导航技术](https://wfqqreader-1252317822.image.myqcloud.com/cover/473/32855473/b_32855473.jpg)
3.2 线性融合模型和算法
本节将考虑线性融合问题,这里的线性融合包含两方面的含义:
(1)测量方程线性。
(2)在分布式和混合式融合结构中,局部估计可以看作虚拟的观测量,对应的虚拟测量方程为线性方程。
3.2.1 线性统一模型
在多敏感器融合结构中,现有的融合算法不仅与信息类型有关,还受制于融合结构,各种融合算法需要根据信息类型和融合结构进行开发。目前描述信息统一模型的方法有两种:一种是从信息类型出发,提出信息的统一融合模型,使测量数据、先验信息和预测状态等均可用该信息的统一模型来描述;另外一种是从融合结构方面考虑,提出线性统一模型的概念,将各种融合结构统一起来,使融合算法的选择不再受融合结构的限制。这里介绍第二种方法,建立线性统一模型。
分布式和集中式融合可以看作混合式融合的特殊形式,因此本节直接考虑混合式融合结构。设混合式融合中对m个分布式融合节点和n个额外的敏感器测量值融合,记第i个分布节点的局部估计值为,误差协方差为P(i),则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0001.jpg?sign=1739333716-FUh7PN1KKs4vi6fzEfYqvtzs7HbGLaVo-0-5072d7aa7c27030fbeae53cf7e319d29)
式中,i=1,2,…,m; 。
假设n个敏感器测量方程线性,由下式给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0003.jpg?sign=1739333716-WKRNXo1LKOBP8xh20iWTdoqGfkbdoPOk-0-fb1eb848f3f96c81f2e950693ffb8db1)
式中,j=1,2,…,n。
将式(3-1)和式(3-2)组合在一块可以写作线性统一模型
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0004.jpg?sign=1739333716-rLEzABQWIeuc2HO860XYs2abmyNszBpl-0-bb904277f9faecfeabfaaeb28b3f97cd)
式中,
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0005.jpg?sign=1739333716-13EmQPYjbRH4mWfJBuEJOUjaosaOLpqM-0-0aec7e0d4b26b28bc870898813664068)
注:
可以是先验知识,也可以是局部估计结果。
3.2.2 线性统一模型下的融合算法
由定理2.3可知,对于式(3-3)描述的线性统一模型,如果噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0007.jpg?sign=1739333716-f9XWo2gZVNe13ZGWeBJwLjqZQRi27LBO-0-191b09c67be86973e91045eaa54b724f)
则x的LMMSE估计为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0008.jpg?sign=1739333716-I2kZFZmXUAF4XSVw8PQpK57t1b9J1XuN-0-87bd124560edc8bdc75868f547e1898e)
推论1:给定一个局部估计和观测量z满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0010.jpg?sign=1739333716-LvyMXeps30xCNtTJGYrny8DDmpXQ0P7o-0-652356096a96a2206203bef8af9b3755)
且有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0011.jpg?sign=1739333716-pejROfrdQzJItXojV3k4U0auV1gs3Ygl-0-e0028372387e6badac7c9a0b82375a93)
则两者融合后的LMMSE估计为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0111_0012.jpg?sign=1739333716-1CrzFgS7aYLSVeK9Do4cqZKTyFNilDpc-0-d9d0c03216a38ef461cc7b7b630c1994)
且
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0001.jpg?sign=1739333716-l5MGwoH4YuH3Nss0bqqee935gs8R8qNt-0-514bd8812c688d744c7f420d0f11accf)
式(3-10)为融合后的误差协方差。
注:
式(3-9)和式(3-10)对应的就是卡尔曼滤波的测量更新过程。
推论2:对于测量相互独立的集中式融合,且测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0002.jpg?sign=1739333716-RnuXXWtu3rm9UtP5GuEELmbscdJKzRUN-0-ecfca33a0455dcc8bda815fe407d78f7)
则融合后的LMMSE估计为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0003.jpg?sign=1739333716-ZefFjRBgrvIVOCJpFVrFB0erkfpY6ITq-0-26ffb64b6d9139a1bd667d6660cba58d)
特别的,如果,式(3-12)可以简写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0005.jpg?sign=1739333716-aMi72d6aaRMXUbhvK9fjU1gqa8NxQ2hM-0-e662f47b5721263ac42d656e3650de69)
证明:对于测量相互独立的集中式融合,式(3-3)中的分别可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0007.jpg?sign=1739333716-TO4cAOppEJBAeKJepzsT5T2bgk3ukDFE-0-e308cb15521d3a8ad908a2e3b212f134)
则根据式(3-6)即可得证。
注:
(1)式(3-13)给出的最优估计实际上是对各敏感器测量数据z(i)的加权和,权重为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0008.jpg?sign=1739333716-T4dvx4nbpbQQvulaMDpZatuLfdYFaxxy-0-36d90a219e7242d871c75890f27c032b)
如果状态向量为标量且各敏感器直接对状态进行测量,则状态量的最优融合估计为各敏感器测量值的加权平均,权重为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0112_0009.jpg?sign=1739333716-YA4hbN4tiOMoQyIrLbMUHHUO3YgjgiJM-0-fd63ba2cbfcd8d6649d67ec3e07011d0)
显然,,且式(3-16)的分子代表各敏感器的测量精度。
(2)多敏感器的LMMSE估计精度优于任意单一敏感器测量给出的LMMSE估计精度,即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0113_0002.jpg?sign=1739333716-Rlv0LEI1tVnXyjEsSDPSoMguo6J750hk-0-91ab86c43f673dce79aef5d3b8a5235b)
推论3:对于分布式融合,如果有m个分布式融合节点且第i个分布节点的局部估计值为,误差协方差为P(i),且第i个节点和第j个节点的互协方差为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0113_0004.jpg?sign=1739333716-wqVxnY1utrJZxmsWlBOQe6TJL8DURssb-0-721601ce5d4147223c9e1c7b32e835ef)
其中,则式(3-6)中的
分别为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0113_0007.jpg?sign=1739333716-UoXzbO1KBPeFojUYDVGmO1p2llJ2pLQZ-0-6a868070c3fd25c9c43ef9cb11f86969)
特别的,
(1)如果P(ij)=O,则式(3-6)可以简化成
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0113_0008.jpg?sign=1739333716-bbx2D23cY5JCgIBG8Wfd0YHF6NVDSl13-0-83c39ba03a5925156ec5aa6f2a887912)
(2)如果m=2,则
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0113_0009.jpg?sign=1739333716-PCFvjcuT2RC3pRXWjLR0LN0Om1ISUi8c-0-a1ccce26d105402a3934d1513c9d70ef)
式(3-21)又称作Bar-Shalom Campo(BC)融合算法。
3.2.3 分布式融合中的协方差交叉算法
分布式或混合式融合的LMMSE估计需要计算互协方差(Cross-Covariance)P(ij)。但实际中,P(ij)可能未知,或者计算过程十分烦琐。为了克服这些困难,Simon Julier等人提出了协方差交叉(Covariance Intersection,CI)算法,并经过不断的发展,广泛地应用在信息融合领域中。
CI算法的优势在于:
(1)避免了互协方差的辨识和复杂计算;
(2)融合后的估计为一致估计,不发散;
(3)融合后的估计精度优于局部估计;
(4)给出了实际估计误差协方差的上界,因此不依赖于未知的互协方差,换句话说,CI算法在适应未知互协方差方面的鲁棒性更好。
在介绍CI算法之前先给出估计的一致性(consistency)定义:为x及其误差方差的估计,如果
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0114_0002.jpg?sign=1739333716-SJzNi9Nys4qgOH2DOsfw2Uc0wcIjokSR-0-25dd32f24a91709de3ca5fd74fbc38ab)
则称具备一致性,对于滤波问题,如果估计满足一致性,则能够有效防止滤波发散。
为了叙述方便,以两个分布式节点为例对CI算法进行说明。记两个局部估计值为,误差协方差为P(1)、P(2)。在实际中,只知道P(i)的估计值(记为
)。为了满足一致性,有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0114_0006.jpg?sign=1739333716-axRAXRE611DbwsFayoi6EhZiDfuE6J9L-0-778e87649125fb30bde1b6f04d6a455d)
融合后的估计也需要满足一致性,即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0114_0007.jpg?sign=1739333716-0gMBIrpRpjzGHv2xZOY2NyZhjKjX1oR4-0-3337e6591765e1f053ff692c85c67a21)
CI算法对局部状态和协方差的估计进行凸组合得到全局状态和协方差估计,算法如下
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0114_0008.jpg?sign=1739333716-c3cYHbweOudnjME8vWlCUldYCUk8e7Tn-0-31be8d5bfcd8ad744531c7748f347d02)
式中,ω∈[0,1]为权重因子。ω的最优值可以对的迹或者行列式进行优化得到,比如
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0114_0010.jpg?sign=1739333716-MaKRsiWx3sCZWaSNdQcl5bnTl8efVGqG-0-8f6578a75916f908c07ea176e6a199fd)
由于优化指标是关于ω的凸函数,有且仅有一个最优点,故可以采用牛顿迭代算法或其他非线性优化算法对ω进行数值求解。
定理3.2:对于任意的ω,CI算法融合后的估计满足一致性,即。
证明:CI算法融合后的真实估计误差为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0115_0002.jpg?sign=1739333716-Wh5ht4aMNmsKYI9Now4boX3Mw3AECB0t-0-b427d6d489bfc02c04ebc1488a52a938)
其中ω1=ω,ω2=(1-ω)。因此有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0115_0003.jpg?sign=1739333716-NAnkOH7MyFmxmaQt0CSmDHhqv1Mp9QD9-0-cbd1e13d71df0d1ac122aa839ac9d7f2)
首先考虑ω∈(0,1)的情况,由附录式(C-32)和式(3-23)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0115_0004.jpg?sign=1739333716-3doQm65Kof43fsZU1ywZsX2WD7aYKxRR-0-fffc692376d388a73f3f9953d3b61c70)
将式(3-29)代入式(3-28)中可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0115_0005.jpg?sign=1739333716-E7iMKbXsT5jFzgMxaFgvAGAJ6Lp0KPTI-0-dde25550b267c772ff05c4c81499063c)
因此,在ω∈(0,1)时,式(3-24)的一致性条件显然成立。当ω1=0或1时,相当于采用单个局部估计值作为全局估计值,由式(3-23)可知,一致性条件式(3-24)显然满足,从而得证。
图3-4所示为二维CI算法的1σ轮廓。如果局部估计的相关性已知,得到的全局最优估计的1σ轮廓位于局部估计1σ轮廓相交区域的内部。由图3-4可知,CI算法给出的融合估计满足一致性。
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0116_0001.jpg?sign=1739333716-sM2C9mW17LefXq9rNZtx5v7HXRcnbZId-0-4b597d2039d5b0fe10fa7916cb718ac8)
图3-4 二维CI算法的1σ轮廓
(a)局部估计的1σ轮廓;(b),(c),(d)中的实线是不同ω得到的融合后的1σ轮廓
对于含有多个局部节点的分布式融合结构,CI算法由下式给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0115_0006.jpg?sign=1739333716-6hu7n3Vgn8Wjsc64rbuHmjhJJGNpspZ9-0-aa22b5857f37e64357f93feb6170f3c8)
式中,i。如果m>2,则优化多个变量,即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0116_0003.jpg?sign=1739333716-WWCLlpVOc9DwcnXBe5qrVBGP37Fl1Quf-0-f4b4796c82dc7307bf469ee776b01cfc)
这时可以采用Matlab的优化工具箱中的FMINCON、MAXDET和SPDSOL等工具进行优化。m越大,计算量也越大。为了提高计算效率和降低运算复杂度,有学者提出了序列式CI方法,基本思想是将多敏感器的CI转化成两敏感器的CI算法,具体如下:
第1步:对和
进行两敏感器的CI融合,融合后的估计和误差协方差分别记为
。
第2步:对和
进行两敏感器的CI融合,融合后的估计和误差协方差分别记为
。
依次类推。
第m-1步:对和
进行两敏感器的CI融合,融合后的估计和误差协方差分别记为
,则
为最终融合后的估计和误差协方差。