天天看点

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

目录

几种最优估计

估计

最小二乘估计

估计指标

估计结果

性质

加权最小二乘估计

估计指标

估计结果

马尔柯夫估计

递推最小二乘估计

递推最小二乘估计更新公式

最小方差估计

估计指标

估计结果

性质

极大验后估计

几种最优估计

估计

根据测量出的状态量X的测量值

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

得到对X的估计值

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

最小二乘估计

估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

估计结果

由对估计指标求导得零点,知

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

性质

①最小二乘估计是无偏估计,即有

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

②最小二乘估计的均方误差阵

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,其中估计误差

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,测量误差的方差

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

加权最小二乘估计

最小二乘估计不分差别地使用多个量测值使其符合估计指标最后得到估计值,这样常常让估计的准确性被量测性能较差的量测值影响,使得估计效果比只使用量测性能好的量测值进行估计来得低。

加权最小二乘估计使精度高的量测权重大些,精度低的量测权重小些,得到的估计比只使用精度高的量测得到的估计均方误差更小,效果更好。

估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,W为加权矩阵

估计结果

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波
卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

马尔柯夫估计

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

得到的加权最小二乘估计称为马尔柯夫估计,通过证明可以知道马尔柯夫估计是加权最小二乘估计的最优估计

估计结果:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

;

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

递推最小二乘估计

前面的最小二乘估计都是在得到所有量测之后通过构造指标方程得到估计。如果在实际中,随着时间的推移,量测不断增加,量测数值十分庞大,对计算机造成很大的资源浪费,所以需要可以随着新量测的加入对估计进行更新的递推最小二乘估计。

递推最小二乘估计更新公式

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

初值

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

可以任意选取,开始阶段误差跳动将很剧烈,随着量测不断更新,误差逐渐趋于稳定

最小方差估计

估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

估计结果

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

性质

①最小方差估计的无偏性:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

极大验后估计

估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,在z确定的情况下,确定估计

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

使得该条件概率达到最大值

贝叶斯估计

估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

;

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

满足:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

贝叶斯估计和其它估计的转化

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

时,贝叶斯估计与 最小方差估计等效;

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,贝叶斯估计与极大后验估计等效。

极大似然估计

估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

;在量测z确定的情况下,估计

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

使得该条件概率取最大值

线性最小方差估计

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

在估计是量测Z的线性函数条件下使其满足最小方差估计指标

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

估计结果

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波
卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

其中

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

; ,

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波
卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

性质

①无偏性:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

为在量测为Z下的估计

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,有

②线性1:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

③线性2:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

,其中

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

卡尔曼滤波

卡尔曼滤波的优点

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

离散型卡尔曼滤波

卡尔曼滤波基本方程

状态方程:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波
卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

为

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

的一步转移阵;

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

为系统噪声驱动阵;

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

为系统激励噪声序列

量测方程:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波
卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

为量测阵,

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

为量测噪声序列

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

都是零均值的高斯白噪声向量序列(服从正态分布),且二者不相关,即两噪声满足下列噪声条件:

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

离散卡尔曼滤波全套算法基本公式

卡尔曼滤波与惯性组合导航几种最优估计最小方差估计卡尔曼滤波

①通过状态方程进行从k-1时刻到k时刻的预测,此时的估计是基于过去的量测信息进行的,对k时刻的量测没有利用,属于先验估计,准确度较低。

②是在一步预测下得到的均方误差,其大小代表了估计的精度

③滤波增益是使用k时刻的量测对①中的估计进行修正的系数

④状态估计使用更新后的量测信息对①的估计进行修正,得到的是后验估计,准确度高

⑤是在状态估计下得到的均方误差,表征估计的精度

④,⑤就是得到的离散型卡尔曼估计的更新

继续阅读