カルマンフィルタ常識

  1. いくつか持っている共通の状態予測式、?(★)
    予測式は、事前知識のプラットフォームにあなたの反応で、一般的なのは、次のとおりです。
  • プラットフォームは次に、それは、同じ位置を維持するために バツ トン + 1 = バツ トン X_ {T + 1} = X_ {T}
  • もし均一な直線運動(前方に) バツ = [ バツ V ] T X = [X、V] ^ T ; バツ トン + 1 = F X t X_ {T + 1} = {T} FX_ どの 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} =である場合
  1. どのように予測方程式の共分散行列を理解するには?(★)
    上記予測式を通過した後、変数は正規分布に沿ったままです。
    P ^ = F P F T + Q \帽子{P} = FPF ^ T + Q
    :F.単変量正常な状況と伝搬エラーのような、同じです ( u , σ 2 ) > ( 2 u , 4 σ 2 ) (U、\シグマ^ 2) - >(2U、4 \シグマ^ 2) 。Qは、他もたらすために誤差の量である、)(第一部状態方程式があり、いくつかは(第一、第二)しません。
公開された36元の記事 ウォンの賞賛3 ビュー10000 +

おすすめ

転載: blog.csdn.net/wang_jun_whu/article/details/104011962