![航天器多源信息融合自主导航技术](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=1739340707-YQxqLlgo2cSeGb8FDM1CypSm6zn6Xqf1-0-84804a112fb67882d95340298cf644b2)
在线性估计里有一种特殊的估计为线性最小均方误差(Linear MMSE,LMMSE)估计,该估计为x的无偏估计,并使MSE指标最小,也即
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0002.jpg?sign=1739340707-j9GxGy38hqQyUG8afqFdZbNa8tJO50xj-0-93043667aa0ef0651eb73e3598a73341)
且使如下的泛函指标最小
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0003.jpg?sign=1739340707-SUVfaIf2gvdvhw1LecYHdAW6hmny8KYs-0-74be74b5ce73d6fd089744a689db06fd)
首先由无偏性可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0074_0004.jpg?sign=1739340707-V7wCrfp0lmmL4WkNnLbyfFNBYtpujmNI-0-2b0f1d8aaa12a42a26f6cc5026b80e42)
式中,。
因此,式(2-20)可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0002.jpg?sign=1739340707-INuAyyuyaw77RYlAyuBZ3juEDARUWKn7-0-a73be3eef961699f9e8c49373654d930)
将式(2-23)代入式(2-21)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0003.jpg?sign=1739340707-B5dJNOXqaUMqUmHNbG8Q3QXuRkMfEkmr-0-6508db692ba5542d1a100b6a258a2466)
利用附录C.1中的y T x=Tr [xy T]可以将式(2-24)写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0004.jpg?sign=1739340707-zx6C0ypXxHMpp1BbCodxrZ72psCu1htr-0-64b6007c30e346350524fa341036f79a)
其中
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0005.jpg?sign=1739340707-C7Jsj0sSxoa0NDVQu44rl6wznepOwZJv-0-b11d11d06d9826c0235504cfd5c778de)
利用最优必要条件可得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0006.jpg?sign=1739340707-Q9SPb6DjSZ0pbLD8DZ8QnsTrDOzZCEwZ-0-9955bfc3a17d505c7a35e0f5afb0c817)
在求解式(2-27)的步骤中,利用了附录C.4中的
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0007.jpg?sign=1739340707-TQbiPhJb7vqyrI8cKnrF9jXf3TBtKiKB-0-1d8c2dc2e00313391237a07044e88ec3)
将式(2-27)代入式(2-23)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0008.jpg?sign=1739340707-X4bSy3j8uZ08KAwm2gkTDYkSbDDY2SoF-0-795b2564138663f5ea85fdc64cc439b3)
记,则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0075_0010.jpg?sign=1739340707-GXGrSyg7xHEnPtoh4NBd8JhieQ6yR7fk-0-b80141b283ef4b00a96b8296da4585f7)
注:
(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=1739340707-BDl3Z1uEIh522H9X0puQsNq5pNXtL5jj-0-d877c194ef53549217a187d372501bee)
式中,
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0002.jpg?sign=1739340707-Cn6He77osXQ5jOHDaKSY2nq4H017eYZb-0-b5463723131d2b09cdebd282f161e96e)
相应的,MMSE估计的条件协方差矩阵为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0003.jpg?sign=1739340707-oiWWlJZjETZ92SBUwlJ2FifNS1wHs075-0-fd8c9bc01ae595a0911dfc395bf8089e)
注:
虽然式(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=1739340707-mdfepYpWa1rh6YunqqWFFkkneReRFv9n-0-0134bbb1326d597e614469a1b1ba2877)
式中,H为测量矩阵,ν为测量噪声。
1.LMMSE估计
对于线性测量方程,若测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0007.jpg?sign=1739340707-11Tq9AFAN5XXBWoZE4ngrCVBCKsABMH8-0-e10c3cf85da8c3362f3887363c227964)
则式(2-28)的线性最小均方误差估计和式(2-29)
的方差可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0076_0010.jpg?sign=1739340707-btMVJqpi6WyGwPcJCyhYf2aDA1b2IVqy-0-0645b60b89f1f43323d2e1e0071d8a04)
证明:首先由式(2-33)和式(2-34)可得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0001.jpg?sign=1739340707-Y82l0T03lH352nqIsA8yTheG3uU5phmO-0-91e874e52c66e705db0ab494be85477c)
将式(2-36)代入式(2-28)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0002.jpg?sign=1739340707-tAhM27FzZsuwEzJMpqCDFfbvAaKytySC-0-e454d1ca69cd32adbf54625eed42e0ce)
在式(2-37)的推导过程中,利用了附录C.7中的
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0003.jpg?sign=1739340707-I4hthNqGd1GpOd08qKoLT3kFfi3YTfNf-0-c7e0d9a0cdca0181be3ee9864e49a36b)
和
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0004.jpg?sign=1739340707-RP0OnpLD6jpQWaqFqSHhcfXnHCqY7i1O-0-43f055e55f98fbe08dc70e3e0366ce2a)
将式(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=1739340707-isHr7bSuzj0Iz2JLaBnsTpoNg9SkZqzo-0-1a6a26e453b38789a046c7fb14285936)
定理2.3对于式(2-33)给定的线性测量方程,如果测量噪声满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0077_0006.jpg?sign=1739340707-TIOlTFEI8GMuycOj0LWr4clFqu0Tcjas-0-0974fd4f848c341e6e9a45e6eff308fe)
且没有x — 的先验知识,则关于x的线性无偏最小均方误差估计由下式给出
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0001.jpg?sign=1739340707-0EEviEIav5nRALOP9xksYH9x5sOiaB3p-0-184132288a3770dbbd3f7e08a5709d02)
证明:对于线性估计,则有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0002.jpg?sign=1739340707-vXwx2ycbC6qxxixMZnJpG3FeaZIvoH0a-0-b8c4d78291626697cbee397f412750a6)
式中,M和n分别为待确定常矩阵(向量)。
将式(2-42)代入式(2-33)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0003.jpg?sign=1739340707-Ix3HkzRGvqWH6l1vLbA6YYj8vHKw2PIn-0-9e069912eac81cb60538dd18ff379f54)
由无偏性可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0004.jpg?sign=1739340707-wYccaDIbw9lfHtw1cWCKivPyK0bBX3Lw-0-274331adddd91dbced2450140fbdb071)
由x — 的任意性,可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0005.jpg?sign=1739340707-dKfn1APwaN96cxYW2XriBrw2xcmj2VMR-0-a6237cabfbba8f103cfcd54420079ad0)
从而式(2-42)可以写作
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0006.jpg?sign=1739340707-1hSwQUa6wgFO2lHyZJvSusRl5RHwr8mo-0-c2e32ca357e4c28fedf5764934e3c087)
且M满足
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0007.jpg?sign=1739340707-u7NkkirqDkir2fTuw2NbycEQlSO92PUS-0-7409a657bd0ed8cfb56e3b7eb5f49afc)
因此线性无偏最小均方误差估计对应的M满足式(2-47),且使式(2-21)最小。因此其泛函指标为
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0008.jpg?sign=1739340707-f2YO0U447o7XFk7y9SQcARhqY5VSGwRQ-0-85207dc9108185daeab83d4179e760b3)
式中,Tr为矩阵的迹算子,Λ为拉格朗日乘子矩阵。
利用最优必要条件和附录C.4中的矩阵微积分可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0009.jpg?sign=1739340707-HGJgWOu7TugWYGupb0TRvg4XCXTDGaac-0-4b0b2aa343f039f5f97a8b23fe15b546)
式中,▽为梯度算子,见附录C.4。从而可以求得
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0010.jpg?sign=1739340707-rWiWkQbXDHLjccqt1TEpw8RLM6QuGiQc-0-e81538d7b652ec358e8c3077a24ef01f)
将式(2-50)代入式(2-49)的第二式可以得到ΛT=(HTR-1H)-1。再代入式(2-50)可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0078_0011.jpg?sign=1739340707-GmW19J2k2GpnN5BUkr3dARRONJsXInrC-0-cde78e660c6df351f5deda61aa068ef2)
将式(2-51)代入式(2-46)即可得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0001.jpg?sign=1739340707-ha9UiOGd5eJUVlTDBM2LfnpDT7frKuXE-0-ed70989f677e28dfc95b184e81cfd5e1)
而
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0002.jpg?sign=1739340707-PMMCWW5WLrwJL5B6RrXQ5I1vbHwKNMlq-0-290d4a59440bda121377001c880f79c9)
从而得证。
注:直观上看,如果没有的先验知识,则
,此时式(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=1739340707-jlnIHAw75QI2zk6VY8rFCSPmKAkLJo3n-0-236d220e8d968386b6c8263f903874ce)
利用最优必要条件可以得到
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0006.jpg?sign=1739340707-p9q8fVQ06EygoM98lVS7tYxRsty4acLy-0-ca1cbc86c5cdd7abe8624a07ef380dd9)
注:
(1)当E{ν}=0时,为无偏估计,也即
。
(2)记,如果E{ν}=0,E{ννT}=R,则
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0010.jpg?sign=1739340707-YURfwQO7eaPwi06xBd8irMa7NXQmIRbR-0-b3543b06172c172b94074d8ed7d20189)
且当W=R-1时,有
![](https://epubservercos.yuewen.com/6C85C2/17640067807576006/epubprivate/OEBPS/Images/figure_0079_0011.jpg?sign=1739340707-MXkFglRBIhodxTNWWA0n8gxN5ou4MQ9J-0-6d627e76797b6cc56a0cc532f128b4a3)
为最小值。