![航天器多源信息融合自主导航技术](https://wfqqreader-1252317822.image.myqcloud.com/cover/473/32855473/b_32855473.jpg)
2.3 估计算法的解析形式
第2.2节中给出了几种常用的估计方法,在实际中,这些估计方法可以用于理论分析;但是如果需要在实际中应用这些估计方法,则需要具体的计算公式;因此本节考虑一些特殊情况(特殊概率分布或者特殊的结构形式),在这些特殊情况下,能够得到估计算法的解析形式,可应用在具体实际中。
2.3.1 线性估计算法
线性估计限定待估参数的估计值为观测量的线性函数,即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0001.jpg?sign=1739308746-NbNoPQrdmk7hfIz9HCJx6aEdug9AZjAe-0-9e89803863c0be599475094a90224e15)
在线性估计里有一种特殊的估计为线性最小均方误差(Linear MMSE,LMMSE)估计,该估计为x的无偏估计,并使MSE指标最小,也即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0002.jpg?sign=1739308746-7qLKPwiT5UOYMpiRor2TaIL60Yi108kh-0-7a7012177ff7691bd1282082b47648c3)
且使如下的泛函指标最小
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0003.jpg?sign=1739308746-NgqIQ4TYG4lbKMM1yU29ECbaPga0LWSl-0-b0d84d9f8abd60960efc6054b9c4bad6)
首先由无偏性可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0004.jpg?sign=1739308746-EhbnzT32AZ8AUcngZyxmLauqPvLVI1qF-0-6125fdb73423a21727ec6ea94fbdb45e)
式中,。
因此,式(2-20)可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0002.jpg?sign=1739308746-jZm6YhH0ymf3IsKYrRgOk4U6s4KY5fk5-0-f8b2c9803b4407ec7f99d6848183f9a8)
将式(2-23)代入式(2-21)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0003.jpg?sign=1739308746-2LkWmXzmG3zOwc0YRZqJaT7chIo2cQ3M-0-e7b7b5ccc772ff291f16051eb42c3de4)
利用附录C.1中的y T x=Tr [xy T]可以将式(2-24)写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0004.jpg?sign=1739308746-UlaHKcqAYU9bJz27EarKbW2MFeTULqBW-0-3834f27cb460f53abe3046106ebf96f3)
其中
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0005.jpg?sign=1739308746-qTiCzzZf9d9bsjB155CTc9wZSzGM0J8x-0-d88bb217309dc55cf4b01c7109669194)
利用最优必要条件可得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0006.jpg?sign=1739308746-xUCsk0a8XV0A1OgKKzQ0ZUPvNEKstjxI-0-723aa00834afc1934a2d8bf109836060)
在求解式(2-27)的步骤中,利用了附录C.4中的
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0007.jpg?sign=1739308746-JVwjJtRz99PRX1LiGDOqp8ghA0a27sNu-0-d52895b0c709265864f3705dd40ae49e)
将式(2-27)代入式(2-23)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0008.jpg?sign=1739308746-PLD10NTZR2hvICVGTMguY6voOzgTsn0A-0-cf1166278e5d5dacade5aab58a80d661)
记,则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0010.jpg?sign=1739308746-S2L8g6v7gssSTNzBz6RhCCrl6A1tIXqM-0-ce9574eab9cca627898ef3d73d41e948)
注:
(1)LMMSE估计又叫作最优线性无偏估计(Best Linear Unbiased Estimation,BLUE)和线性最小方差估计。
(2)LMMSE估计的优势在于形式简单,仅和概率密度函数的一阶和二阶矩有关,且易于实施。
2.3.2 联合高斯分布的MMSE估计算法
如果待估参数x和观测量z为联合高斯分布(定义参见附录D5.2),则x的MMSE估计由下式给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0001.jpg?sign=1739308746-0NmtUiaEenli4pOuYMHq2s2N6xw67oZp-0-ce194b870252cc6e31a3dfb3aff9430d)
式中,
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0002.jpg?sign=1739308746-Qnavl7dPnMYCCXr8ZsQWY2dFjY2vC6Xo-0-088fea0c6714262a8aa06bcde3975ecf)
相应的,MMSE估计的条件协方差矩阵为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0003.jpg?sign=1739308746-8qVYhcLctZDM3qdVcQX8pUuGLlC46pVI-0-31af5fff61d4f61ffae91a9ff8a8040c)
注:
虽然式(2-29)和式(2-32)的形式一样,但是和P xx|z有着不同的含义。
为MSE矩阵,P xx|z为条件协方差矩阵。
2.3.3 线性观测对应的估计算法
本节考虑线性测量方程情形下的估计方法。观测量z和待估状态x由如下的线性测量方程给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0006.jpg?sign=1739308746-ge7j5y3uEudCxlPPdIrGqjdtcJxmCros-0-2810a20e585b9b500cbf84bbf2af24ec)
式中,H为测量矩阵,ν为测量噪声。
1.LMMSE估计
对于线性测量方程,若测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0007.jpg?sign=1739308746-enwMJPOuDJZIJqIJCIeNnHwsWI9yNWPl-0-ae7f94119d7069c03724262a6a78875c)
则式(2-28)的线性最小均方误差估计和式(2-29)
的方差可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0010.jpg?sign=1739308746-oW7oy1UKdoxUE4d53gwqQrlxxHaJvOAl-0-2f2b6dfc1cc21e17f2203b9c80c6faf3)
证明:首先由式(2-33)和式(2-34)可得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0001.jpg?sign=1739308746-YkxErXPLCMRwrWR5AQopp75QwTjP0Rye-0-47c4d9eebb75a2bf22bb4c8176b660ae)
将式(2-36)代入式(2-28)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0002.jpg?sign=1739308746-iQHq1nwTbjpEMVvNux3D1pOWjfjtKhVc-0-4311db3f185c2231fdc414c2ee1b3d86)
在式(2-37)的推导过程中,利用了附录C.7中的
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0003.jpg?sign=1739308746-wwNZd6ieRE7V2fh8LrGqaaeWFagnGavz-0-0e2427241e531e170e47e4ec6de2c303)
和
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0004.jpg?sign=1739308746-xBcoKxchcaqtjrWCVbsXGxIurHLXxDxk-0-40afafe0438b3af11a80845ae796a97d)
将式(2-37)代入式(2-29)可得式(2-35)的第二式,从而得证。
注:式(2-35)有着几种不同的计算形式,如表2-1所示。
表2-1 LMMSE几种不同的计算形式
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0005.jpg?sign=1739308746-Xf4ghoCOSUqpel97Y0V2rOCdyMbDaEbL-0-7d30ce68a25a2517466021e0bb01975c)
定理2.3对于式(2-33)给定的线性测量方程,如果测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0006.jpg?sign=1739308746-CY7SxihlcCo2uDAG06TX8TCfxGpfPSZY-0-66f56b13025809dc588d96c94bf703cf)
且没有x — 的先验知识,则关于x的线性无偏最小均方误差估计由下式给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0001.jpg?sign=1739308746-MNNCU0X5f7JGvSVTWd2pO7LWCUXxHVE8-0-722fb9127028aa435d89828a6ed8a63c)
证明:对于线性估计,则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0002.jpg?sign=1739308746-3YyqGn2gqN8RiYIFfQEhsffrKJiKvD2A-0-6f0030586ffcefe10a58b01832032165)
式中,M和n分别为待确定常矩阵(向量)。
将式(2-42)代入式(2-33)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0003.jpg?sign=1739308746-6hf4PKuchhqcgZfIdqiMwPWQp4OFUxIJ-0-51a500a3de4b214cf3655442d399ebb7)
由无偏性可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0004.jpg?sign=1739308746-bQit84QHlLEAPzGlg5V154HTzYjq2t9b-0-82d51345c585ac061d67b050d38bd8c3)
由x — 的任意性,可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0005.jpg?sign=1739308746-2CbiQPXpxW9g5G2YOUBcdXeaNXaMubXJ-0-36f27f07d6266d97c5ba25820bc8ca8e)
从而式(2-42)可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0006.jpg?sign=1739308746-8eGJMEOPLEDkRFGoJzC9RNgHy1exLa3T-0-8d9dc258e45f366b853bd947628ff8bb)
且M满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0007.jpg?sign=1739308746-9FptrnXtKhqJ3EQXEA8wjN6eJsr7sPmu-0-50debc76e53339010135f0cd22c23a6f)
因此线性无偏最小均方误差估计对应的M满足式(2-47),且使式(2-21)最小。因此其泛函指标为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0008.jpg?sign=1739308746-XIzS3nFwUyWHl45rmcKCnHDwtmSLIvAy-0-ea4e1e503277c1ffc3cadb06d01373e2)
式中,Tr为矩阵的迹算子,Λ为拉格朗日乘子矩阵。
利用最优必要条件和附录C.4中的矩阵微积分可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0009.jpg?sign=1739308746-Xc0gIKXCtCCHooZ0DGHOLmme2hUA93iB-0-308317ed0c54184ccb0c09e47f7ff837)
式中,▽为梯度算子,见附录C.4。从而可以求得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0010.jpg?sign=1739308746-SQEYYPjxAyMx0qWOrRs1Px1mKOEt0WGy-0-418f8525ecad8525ed4f559804aa1b5e)
将式(2-50)代入式(2-49)的第二式可以得到ΛT=(HTR-1H)-1。再代入式(2-50)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0011.jpg?sign=1739308746-GPn0ixxoyTlFqjq2hEROSSnwAnjyZwai-0-6a550a1c6a67c91f95e4eb432a773f92)
将式(2-51)代入式(2-46)即可得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0001.jpg?sign=1739308746-ozUZGhd6PmNmWRUz5EPmZrofjQXuLfLx-0-8b5d7cf0ba90c362853d95aea37d5f4d)
而
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0002.jpg?sign=1739308746-RpLhfwDOK9H4RztwZuRHu2TCFsCykfVv-0-3cf3125be1d49cf012a479bd64119763)
从而得证。
注:直观上看,如果没有的先验知识,则
,此时式(2-35)可以化简成式(2-41)得到定理2.3。
2.加权最小二乘估计
对于式(2-33)给出的线性测量方程,式(2-18)中的WLS估计可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0005.jpg?sign=1739308746-4Ez7j7aGFLAaVVOb5xKDmqHBQEGCA3SA-0-5b1929bbdaac87e819e66173c7ab8c1e)
利用最优必要条件可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0006.jpg?sign=1739308746-cmz8vAUk6EfY8yTz5ROmZKZqGhKVkbg0-0-82e065edf58075a764472d031962a2b0)
注:
(1)当E{ν}=0时,为无偏估计,也即
。
(2)记,如果E{ν}=0,E{ννT}=R,则
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0010.jpg?sign=1739308746-0CoCb7jv2Zvv64wuNx7jyEP7Gurdf0ty-0-1320ea90b5c82a2fef66848beb938995)
且当W=R-1时,有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0011.jpg?sign=1739308746-JgRV5rG7nfKyNEAf0sXkBcZQ6pc9tFTM-0-3dc350a405be2e566cadf954d1b0a522)
为最小值。