卡尔曼滤波常识

  1. 常见的状态预测方程有哪几种?(★)
    预测方程反应的是你对平台的一个先验知识,常见的有:
  • 平台保持位置不变,那么就是 x t + 1 = X t x_{t+1} = X_{t} .
  • 如果是匀速直线运动(前面的), X = [ x , v ] T X = [x, v]^T X t + 1 = F X t X_{t+1} = FX_{t} , 其中 F = [ 1 , 1 ; 0 , 1 ] F = [1,1; 0, 1] ;
  • 如果是匀加速直线运动,情况就稍微复杂一些; X t + 1 = f ( X t ) X_{t+1} = f(X_{t}) , 当把时间间隔当做常量时,f依然是一个线性函数, X_{t+1} = FX_{t} + [1/2a; a].
  1. 预测方程的协方差矩阵如何理解?(★)
    在通过上面的预测方程之后,变量依然是符合正态分布的。
    P ^ = F P F T + Q \hat{P} = FPF^T + Q
    F的形势和单变量正态分布误差传播是一样的,如: ( u , σ 2 ) > ( 2 u , 4 σ 2 ) (u,\sigma^2)->(2u, 4\sigma^2) . Q是一些其他量带来的误差,有的状态方程有(第三种),有的没有(第一种,第二种)。
发布了36 篇原创文章 · 获赞 3 · 访问量 1万+

猜你喜欢

转载自blog.csdn.net/wang_jun_whu/article/details/104011962
今日推荐