在贝叶斯滤波的框架下,卡尔曼滤波的有效性依赖于以下六个关键假设(注:从最小二乘法(Least Squares, LS)的角度推导卡尔曼滤波时,最后两个假设不再必要)。这些假设共同保证了状态估计的高斯分布特性以及递推更新的可解析性:
-[x] 线性系统模型:状态转移和观测模型都必须是线性的。状态的变化和传感器的测量都通过线性方程描述,任何非线性因素都会破坏卡尔曼滤波的精确性。
-[x] 马尔可夫性(无记忆性):当前状态仅依赖于前一时刻的状态,而与更早的历史状态无关;同时,当前的观测值仅依赖于当前的状态。这一特性简化了递推计算,使滤波过程仅需维护当前状态。
-[x] 噪声独立性:过程噪声和观测噪声必须相互独立,并且与初始状态无关。这意味着噪声在不同时间步之间、以及噪声与状态之间没有相关性。
-[x] 已知模型参数:系统的状态转移矩阵、观测矩阵、噪声协方差矩阵等参数必须预先准确已知。如果这些参数不准确或随时间变化,滤波性能会显著下降。
-[x] 高斯噪声分布:过程噪声(系统噪声)和观测噪声(测量噪声)都必须服从零均值的高斯分布。这一假设使得噪声的影响可以用协方差矩阵精确描述,并保证后验概率仍为高斯分布。
-[x] 初始状态的高斯分布:系统的初始状态必须服从高斯分布,即具有已知的均值和协方差矩阵。这样,后续的预测和更新才能保持高斯特性。
这些假设确保了卡尔曼滤波能够以最优(最小均方误差)的方式递推估计状态。
1.时间更新
离散情况:
\[
p(y)=\sum_{x}^{}\left[p(y|x)p(x)\right]
\]
连续情况:
\[
p(y)=\int_{-\infty}^{\infty}p(y|x)p(x)\mathrm{d}x
\]
2.量测更新
离散情况:
\[
p(x_{i}|y)=\frac{p(y|x_{i})p(x_{i})}{\sum_{j}^{}\left [ p(y|x_{j})p(x_{j}) \right ] } =\frac{p(y|x_{i})p(x_{i})}{p(y)}
\]
连续情况:
\[
p(x|y)=\frac{p(y|x)p(x)}{\int_{-\infty}^{\infty}p(y|x)p(x)\mathrm{d}x}=\frac{p(y|x)p(x)}{p(y)}
\]
3.具体的卡尔曼滤波推导

先验=\int_{-\infty}^{\infty}\frac{1}{\sqrt{2\pi Q}} exp\left [ -\frac{(x-Fs)^2}{2Q} \right ] \frac{1}{\sqrt{2\pi P}} exp\left [ -\frac{(s-\bar{x})^2 }{2P} \right ]\mathrm{d}s
\]
上式中的\({\bar{x}}\)表示上一时刻的后验均值,\({P}\)表示上一时刻的后验协方差。
\[后验=\frac{\frac{1}{\sqrt{2\pi R}} exp\left [ -\frac{(y-Hx)^2}{2R} \right ] \frac{1}{\sqrt{2\pi P’}} exp\left [ -\frac{(x-\bar{x}’)^2 }{2P’} \right ]}{\int_{-\infty}^{\infty}\frac{1}{\sqrt{2\pi R}} exp\left [ -\frac{(y-Hs)^2}{2R} \right ] \frac{1}{\sqrt{2\pi P’}} exp\left [ -\frac{(s-\bar{x}’)^2 }{2P’} \right ]\mathrm{d}s}
\]
上式中的\({\bar{x}’}\)表示当前时刻的先验均值,\({P’}\)表示当前时刻的先验协方差。