卡尔曼滤波器-先验估计、后验估计、卡尔曼增益、先验误差协方差矩阵、更新协方差矩阵公式详细数学推导 | 由卡尔曼滤波器推导扩展卡尔曼滤波器
xk=Axk−1+Buk−1+wk−1zk=Hxk+vk\begin{align*}x_k&=Ax_{k-1}+Bu_{k-1}+w_{k-1}\\z_k&=Hx_k+v_k\end{align*}xkzk=Axk−1+Buk−1+wk−1=Hxk+vk 首先给出状态空间方程,其中xkx_kxk是状态变量,AAA是状态矩阵,BBB是控制矩阵,uk−1u_{k-1}uk−1是控制,wk−1w_{k-1}wk−1是过程噪声,过程噪声是不可测的,是不确定性的一种表现,但是在自
复制链接