カルマンフィルターで予測できないノイズをモデル化する方法は?


9

バックグラウンド:

ロボットの進行方向を推定する単純なカルマンフィルターを実装しています。ロボットにはコンパスとジャイロスコープが搭載されています。

私の理解:

私は、2次元ベクトルとしての私の状態を表す考えていますところ、xは現在の進行方向であると ˙ Xジャイロスコープによって報告された回転速度です。(x,x˙)xx˙

質問:

  1. 私の理解が正しければ、私のフィルターには制御項はありません。本当ですか?状態を1Dベクトルx )とするとどうなりますか?その後、私が行う˙ xは制御項となり、U?これら2つの方法で異なる結果が得られますか?u(x)x˙u
  2. ご存知のように、主なノイズ源はコンパスが歪んだ磁場内にあるときにコンパスから発生します。ここでは、ガウスノイズはそれほど重要ではないと思います。しかし、磁気歪みは完全に予測不可能です。カルマンフィルターでどのようにモデル化しますか?
  3. カルマンフィルターでは、「すべてのノイズが白い」という仮定が必要ですか?たとえば、実際のノイズ分布がラプラシアン分布である場合でも、カルマンフィルターを使用できますか?または、拡張カルマンフィルターなどの別のフィルターに切り替える必要がありますか?

回答:


6
  1. θ˙^=ωgyro+w
    y^=x^
    y^
  2. いずれかの場所に座った場合、一定のオフセット項として表示されるため、磁気歪みは難しくなります。カルマンフィルターはこれをうまく処理できません。歪みをマッピングするか、2番目の絶対方向参照を取得するか、または歪みを受け入れる必要があると確信しています。
  3. スペクトルコンテンツと確率分布を混同しています。ノイズが白い場合、各サンプルは他のサンプルから完全に独立しています。ノイズがラプラシアンの場合、各サンプルはラプラス分布に従います。カルマンフィルターはカラーノイズを好みません(ただし、状態を追加することで対処できます)。カルマンフィルターは、ノイズがガウス分布で、コスト関数が二乗和である場合にのみ、全体的に最適なフィルターになります。その他のノイズおよびコスト関数の場合、最適なフィルターはおそらく非線形です。ただし、ゼロ平均、ホワイトノイズ、および二乗和のコスト関数の場合、カルマンフィルターが最適な線形フィルターです。

(私が与えたシステムモデルは、かなり自明なカルマンフィルターで終わることに注意してください。コンパスオフセットを推定する他の手段が見つからない場合は、補完的なフィルターを使用してこれらの2つのセンサー入力を組み合わせることをお勧めします。とにかく、すべてのカルマン計算は、補足フィルターを咳き込んでしまうだけであり、定数の十分な推測があり、補足フィルターのクロスオーバーポイントを推測してそれを実行できる可能性があります)。

(また、絶対位置参照があり、速度を推定する手段があり、常にそれを指す方向に向かう車両がある場合、拡張カルマンフィルターを使用すると、非常に有益にコンパスの歪みを修正できます。コンパスの方向を修正するために実際に移動する方向)。

Wiley 2006のDan Simonによる最適な状態の推定は、私の意見では、カルマンフィルタリングの主題とそのより洗練された兄弟(H無限大、拡張カルマン、無香料カルマン、そして少しでもベイジアンおよびパーティクルフィルタリング)。それをこのようなナビゲーションの問題に適用する方法はわかりませんが、すべての問題が解決されたら、人生のどこが楽しいでしょうか。サイモンの本の数学を理解できない場合は、カルマンフィルターを何らかのインテリジェントな方法で適用できるかどうかを自問する必要があります。


+1このアプリケーションの補完フィルターには、より適しているようです。ダン・サイモンの本もとても良いです。この記事は、カルマンフィルター(同じ作者による)の良い紹介です。masys.url.tw
AU/2013SP/

@ddevazええ、私は実際に今補完フィルターを実装しています。しかし問題は、それが非常に良い結果をもたらさないことです。だから私は別の「より洗練された」フィルターに切り替えることを考えています...
Sibbs Gambling 2013

そうですか。ジャイロ、加速度計、および磁力計を使用したカルマンフィルターの実装に関する参考資料を含めるように、私の回答を編集しました。
ddevaz

3
  1. 制御入力項はありません。カルマンフィルターを適切に定式化するには、状態ベクトルとして(x、xdot)を使用する必要があります。

  2. 主要なノイズ源はコンパスとジャイロスコープです。ジャイロスコープのノイズとドリフトは重要です。一般に、磁気歪みを克服することは非常に困難ですが、補償手法があります。

  3. ゼロ平均多変量正規分布ノイズの仮定が必要ですが、ホワイトノイズはこれの特殊なケースにすぎません。拡張カルマンフィルターの場合、この仮定は依然として真である必要があります。他のタイプのフィルター(粒子フィルター無香料カルマンフィルター)を調べることができます。

カルマンフィルターの設計/実装に関する論文:

慣性/磁気センサーによる3D方向検出のためのセンサーフュージョンアルゴリズムの実装


それで、私はKFを離れて、予測できない磁気歪みを処理することはできませんか?まず、歪んだ値を破棄してから、KFを離れてセンサーノイズに対処する必要があります。正しい?
Sibbsギャンブル2013

はい。カルマンフィルターは、変化が激しいため、磁気歪みを正確に補正することができません。最初に磁気補償を実装してから、カルマンフィルターを実装します。
ddevaz
弊社のサイトを使用することにより、あなたは弊社のクッキーポリシーおよびプライバシーポリシーを読み、理解したものとみなされます。
Licensed under cc by-sa 3.0 with attribution required.