![航天器多源信息融合自主导航技术](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=1739673840-lv1TqhFCjw8y9aDlwgEGbpqt0rvwnltE-0-17201b5e26d4a4089c83728a3f0c5f19)
在线性估计里有一种特殊的估计为线性最小均方误差(Linear MMSE,LMMSE)估计,该估计为x的无偏估计,并使MSE指标最小,也即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0002.jpg?sign=1739673840-F0wvggr0oKBgwUK7WNu4Zsdj0sBHvA1O-0-ee71ac7e58bda076a311832a6ef98da9)
且使如下的泛函指标最小
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0003.jpg?sign=1739673840-tmWcUzbZAMOth46nbgv4vnZrfK7tRNgx-0-824e2cee7624b9e552f2b7e4e1e28e23)
首先由无偏性可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0004.jpg?sign=1739673840-INdCuR3VCpAYpCuQzHBIqbpiMU7cDKgm-0-ce7686028482ed90b90edf1dc26cdfa8)
式中,。
因此,式(2-20)可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0002.jpg?sign=1739673840-S3ZoErVGiDAsKR3VEn0fIc2khT6xhMMO-0-c0b80482e6fc3b04f7cced56028b7601)
将式(2-23)代入式(2-21)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0003.jpg?sign=1739673840-B2ILiudBBAD9gDR5cFJLfBQUmh6zymH7-0-08a2619e3bc6fc95767db8b5155338e6)
利用附录C.1中的y T x=Tr [xy T]可以将式(2-24)写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0004.jpg?sign=1739673840-XPltnIjJlTAcfCKFUsXRcK32zjfwDNqn-0-8341fee9095bcc5c7317087a0e8364df)
其中
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0005.jpg?sign=1739673840-X9l8WLvbtjfKXyvd7DAx7g7Zs762fQTW-0-ced683fca87f0d6d7c6318c649ae4aad)
利用最优必要条件可得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0006.jpg?sign=1739673840-RiJL5ZItUYyNCsK0mBidyJHSArYBmV31-0-842f3b3b56040575e8d3aa64c3358a7b)
在求解式(2-27)的步骤中,利用了附录C.4中的
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0007.jpg?sign=1739673840-SjbP0hmpoxDQVn8nrD1f94v3vsSzb786-0-0aa5efd71a79acfe84ed9c7f000a10a6)
将式(2-27)代入式(2-23)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0008.jpg?sign=1739673840-R3cvFOkhn06UUMBWCI6YBnI1kDc1Zhqh-0-cdbbd28edfa606099d9cf759bf06b610)
记,则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0010.jpg?sign=1739673840-Ip4PwVbFtYnZ5iEC0MeK25dLeT3QebqE-0-3da9d5e0fc953f80b31e58de4a3f6353)
注:
(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=1739673840-cRy0XTcPi63Lx4Z6qRMEbjs43NpWc74w-0-efedfdb9c35f35824e952f80901bdfbe)
式中,
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0002.jpg?sign=1739673840-n43o3xcjfsLTFg2xFGuPiZS8EQewsCOs-0-2f886a787205c2577eedd851058389a4)
相应的,MMSE估计的条件协方差矩阵为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0003.jpg?sign=1739673840-LDFV3sElGlNrlnatkkthlB80moAteaBS-0-bab5d4e60fb464b9f78eae883882611a)
注:
虽然式(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=1739673840-P4GVvST1DGWk3w8v3OvUPTWfxooRU0zK-0-11cc7be1e31ecac33820a34a2356aedc)
式中,H为测量矩阵,ν为测量噪声。
1.LMMSE估计
对于线性测量方程,若测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0007.jpg?sign=1739673840-TLrTVs1CvvC2Kcyz9VcGSksNyfXtn1Og-0-fc04342eaca4c7f0f48c30ea4c13ba89)
则式(2-28)的线性最小均方误差估计和式(2-29)
的方差可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0010.jpg?sign=1739673840-GSSE1km1N6vN9qowCsBKRJokqtwZxN0e-0-b725419012a8b151b8210514ade06598)
证明:首先由式(2-33)和式(2-34)可得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0001.jpg?sign=1739673840-cbKrdXlP5y3hLM8gYh1kbeoP4Cw1DneA-0-37e5c676f4f6a9f8fcad806611c980b5)
将式(2-36)代入式(2-28)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0002.jpg?sign=1739673840-B0gLidIXdRrABAGfqHGnaoX21Q6iZGlu-0-6b5e1678d2cc5840132486ccb949b6c7)
在式(2-37)的推导过程中,利用了附录C.7中的
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0003.jpg?sign=1739673840-QpLWTVjrwDAdX5E50f3g4w5X7wbpAHC6-0-dee5178d11bb8b8c11e86ee88989d2bd)
和
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0004.jpg?sign=1739673840-buOKe8PWvyn0Gib9PiBoGrJMHA0RomZ5-0-365e7f7b498bd6cd7485716338245487)
将式(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=1739673840-TM1kiiCcx7Fh5MBJg7q3u7SDmEV0xVVL-0-d56e4a670018828d2a5810619b005f1f)
定理2.3对于式(2-33)给定的线性测量方程,如果测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0006.jpg?sign=1739673840-nG1huWjFK8vyhddcdWUCgt6PfOLn7ros-0-00084dc71a05f4e6589f2f3d2ff16df1)
且没有x — 的先验知识,则关于x的线性无偏最小均方误差估计由下式给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0001.jpg?sign=1739673840-cWZbMMVNQ7kqWKPgKMql5qRTqWuQSdry-0-0d2f199bbd53db275f7d0823b0ba9186)
证明:对于线性估计,则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0002.jpg?sign=1739673840-jmrQRC8bNVydw4hxhoPZXpfrDBc04ZvI-0-7b7fb3c76c3cff1ec31d6312a5f77ade)
式中,M和n分别为待确定常矩阵(向量)。
将式(2-42)代入式(2-33)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0003.jpg?sign=1739673840-6YLEdkfjL9LDv2upEBaUPftUbcRAvDI2-0-e94dc18b20a0ec7a416bdb5eede8d5c8)
由无偏性可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0004.jpg?sign=1739673840-YZeOvufAezMzEA0y9hLc9QHnLfjgvwWz-0-2d200498bb5f88609a5fbe79cb02694d)
由x — 的任意性,可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0005.jpg?sign=1739673840-EoK2sgrcEROTJLfnU1LnDkyNEkquDa4Q-0-4859dcf7afac37503d9bbbab185bb099)
从而式(2-42)可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0006.jpg?sign=1739673840-l1dgASeeOwE9Ev0zmgfobhc4KI34MlSE-0-00f5626c8f36a2c56e06b23f01642034)
且M满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0007.jpg?sign=1739673840-q8qeOlGV5ZWCOaTFHEWkNPMHpJGAifSJ-0-6a89fd99c47bcb699bd5c1c73a6d1464)
因此线性无偏最小均方误差估计对应的M满足式(2-47),且使式(2-21)最小。因此其泛函指标为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0008.jpg?sign=1739673840-blRQzEvPna4VJXnd3AsiVSdXE5kw8EPx-0-995d332ed283e347d92b8b6bc720951f)
式中,Tr为矩阵的迹算子,Λ为拉格朗日乘子矩阵。
利用最优必要条件和附录C.4中的矩阵微积分可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0009.jpg?sign=1739673840-ZHO34KQ58LSvnfb6YmMNuAVavXLr3zOU-0-6246981efeb98ed5bec3066360841877)
式中,▽为梯度算子,见附录C.4。从而可以求得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0010.jpg?sign=1739673840-R6i55qzeixfRKNjqG45R201ltVEzRaib-0-d47a934be0a8132820534d9b98fc3e5b)
将式(2-50)代入式(2-49)的第二式可以得到ΛT=(HTR-1H)-1。再代入式(2-50)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0011.jpg?sign=1739673840-4rlz8uhhKHRzfkwdb5g6yRSEO4b6tpXa-0-7636dcbecde10261bb6c9edf52ed862b)
将式(2-51)代入式(2-46)即可得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0001.jpg?sign=1739673840-tQ57IEvhPWMuwR0KEaa2fqkZT8BNoPns-0-5f05eec8f94ed5a8dda242344dcf34d6)
而
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0002.jpg?sign=1739673840-xmETeiNsv3yZMxyYYp3fdl17xzyTNGEY-0-ec500cbe70202e54f9f57c38c63b98fd)
从而得证。
注:直观上看,如果没有的先验知识,则
,此时式(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=1739673840-XNLNNDqOpPWMWxM2NemTBFmr8IsCMk0n-0-ae98582c7984c5d3f62dde3ab905f449)
利用最优必要条件可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0006.jpg?sign=1739673840-TVn7Ow9PI4bG7QjOFPTZAhgdI8MD76cs-0-d1eacb33a878e314f17cfb1b5e2d7070)
注:
(1)当E{ν}=0时,为无偏估计,也即
。
(2)记,如果E{ν}=0,E{ννT}=R,则
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0010.jpg?sign=1739673840-lcVMX3PRJ5je7NSJ9EFjJCzB4gfm5Au8-0-3dfac762a9b779cbb1e4b232a3547546)
且当W=R-1时,有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0011.jpg?sign=1739673840-oEceX0XJ8jXqgrbfxlF9bjkU6R1NjqAl-0-2cf357fb912aa2c9543dbb6e71239173)
为最小值。