Skip to content
検索結果に戻る

Mahony Filter

提唱者
Robert Mahony
年
2008
種類
Observer algorithm
系統
Complementary Filtering

この文章は機械翻訳で、まだ確認されていません。 英語の原文を読む

文字サイズ

何をする手法か?

Mahony Filterは、ジャイロスコープ、加速度計、磁力計の測定値を融合してクォータニオン姿勢を推定する、相補オブザーバーベースの姿勢フィルターです。Robert Mahonyらが2008年に開発したこのフィルターは、ジャイロスコープのレート積分と、比例積分制御の原理を用いたベクトル測定(加速度計、コンパス)からの補正フィードバックを組み合わせます。Mahony Filterは、カルマンフィルターと同様の性能を提供しますが、実装がより単純で計算コストが低いため、リソースが限られたシステムやリアルタイム制御に最適です。

手法の背後にある直感

Mahony Filterを閉ループ制御器として考えてみてください。ジャイロスコープは「開ループ」推定値(高速だがドリフトする)を提供し、加速度計/コンパスは誤差信号(低速だが安定している)を提供します。比例積分(PI)制御器は補正を計算し、それをジャイロスコープの積分ループにフィードバックします。高いジャイロスコープゲインは速い応答をもたらし、高い加速度計ゲインは安定性を提供します。この2つは、応答性とドリフトのない姿勢の両方を達成するためにバランスが取られます。

歴史学

Robert Mahonyとオーストラリア国立大学の同僚は、クアッドローター制御に取り組んでいた2008年頃に、相補オブザーバーアプローチを開発しました。この方法は、マルチローター姿勢推定に関するいくつかの影響力のある論文で形式化されました。Mahonyの定式化は、古典的な相補フィルター(航空宇宙で何十年も使用されてきた)と現代のクォータニオン代数および制御理論を統合しました。このフィルターは、オープンソースのオートパイロットコミュニティ(ArduPilot、PX4)で標準となり、研究および商用システムで広く使用されています。

使うべき場面

カルマンフィルターが複雑すぎる、またはコストがかかりすぎる場合に、組み込みシステムでの姿勢推定にMahony Filterを使用します。クアッドローター、マルチローター、航空機のオートパイロットに最適です。Madgwick(勾配降下法を使用)に代わる、物理的に動機付けられ、調整が容易な代替手段が必要な場合に展開します。低遅延で安定した推定を必要とするリアルタイム制御ループに適しています。比例積分制御を理解しており、K_p、K_iを調整できる場合に使用します。

限界と注意点

  • K_pとK_iの調整には、制御理論の理解と経験的な実験が必要です。
  • 性能は調整に敏感。ゲインの選択が悪いと、振動や応答の鈍化を引き起こす可能性があります。
  • 積分項がワインドアップを引き起こす可能性。大きく持続的な誤差が蓄積し、オーバーシュートを引き起こす。緩和策が必要です。
  • Madgwickと同様に、磁力計の擾乱が方位の精度に影響します。キャリブレーションと、場合によっては擾乱検出が必要です。

出典に示された条件は、独立した科学的レビューや分析エンジンによる検証の代わりにはなりません。

強み

  • 物理的に直感的。制御理論(PIフィードバック)に基づいている。勾配降下法よりも理解しやすく、デバッグしやすい。
  • 明示的なジャイロスコープバイアス推定。積分項は時間の経過とともにセンサーバイアスを学習し、補正します。
  • 2つの調整パラメーター(K_p、K_i)は、Madgwickのbetaとは異なり、明確な物理的意味(比例ゲインと積分ゲイン)を持ちます。
  • Madgwickと同様の計算コスト。軽量で組み込みシステムに適しています。

応用

  • クアッドコプターおよびマルチローターの飛行制御:ほとんどのオープンソースオートパイロット(ArduPilot、PX4)における主要な姿勢推定器。
  • 固定翼航空機のオートパイロット:低コストUAV飛行制御器における姿勢基準。
  • 無人航空機(UAV)研究:学術的な運動制御研究における標準フィルター。
  • 船舶の方位および安定化:船舶のオートパイロットおよびロール安定化のための姿勢基準。
  • 移動ロボットの姿勢追跡:車輪型および脚型ロボットの姿勢推定。

使い方

使い方

1

9自由度IMUから測定値を収集します。3軸加速度計、3軸ジャイロスコープ、3軸磁力計を50Hz以上で測定します。

2

加速度計と磁力計のベクトルを正規化し、ジャイロスコープのレートを取得し、利用可能であればキャリブレーションを適用します。

3

重力(下方向)と磁北(現在の姿勢推定値から)の期待される方向を計算し、測定された方向と比較し、誤差を外積(幾何学的誤差)として計算します。

数式
\dot{\vec{q}} = \frac{1}{2}\vec{q} \otimes \vec{\omega} + k_p \vec{e} + k_i \int \vec{e} dt
4

比例補正(K_p * error)と積分補正(K_i * integral(error))を適用してジャイロスコープのバイアスを推定し、補正された角速度を使用してクォータニオンを更新します。

5

クォータニオンを出力し、必要に応じてオイラー角に変換し、誤差の大きさやセンサーの一致度に基づいて信頼性を評価します。

よくある落とし穴

  • K_pとK_iが高すぎると振動と不安定性を引き起こします。一般的な値はK_p〜1.0、K_i〜0.1で、経験的に調整されます。
  • 積分項の境界設定を忘れること。無制限の積分は誤差を蓄積する可能性があります。積分ワインドアップの制限を導入します。
  • 加速度計の誤差モデルがガウス分布であると仮定すること。非ガウス分布の擾乱(振動、衝撃)はフィルターを破損する可能性があります。ロバストな推定器が必要になる場合があります。
  • 意図した運動プロファイルでのテストなしに展開すること。フィルターの調整は、予想される操縦レートとセンサーの品質に依存します。

よくある質問

K_pとK_iはどのように調整すればよいですか?

K_pは比例ゲイン(通常0.5~2.0)です。K_pが高いほど補正は速くなりますが、振動のリスクがあります。K_iは積分ゲイン(通常0.01~0.1)で、バイアス補正の速度を制御します。K_p=1.0、K_i=0.1から始めます。フィルターが操縦に遅れる場合はK_pを上げ、振動する場合は下げます。バイアスドリフトが大きい場合はK_iを上げ、積分ワインドアップが発生する場合は下げます。

積分ワインドアップとは何ですか、またそれを防ぐにはどうすればよいですか?

積分ワインドアップは、持続的な誤差(例:磁力計の擾乱)の間に積分項が際限なく増加するときに発生します。誤差が最終的に解消されると、フィルターはオーバーシュートします。これを防ぐには、積分項を飽和させる(制限内で境界を設定する)か、条件付き積分(誤差が小さい場合にのみ積分する)を行います。

MahonyフィルターとMadgwickフィルターの違いは何ですか?

Mahonyは明示的なバイアス推定を伴うPIフィードバックを使用し、Madgwickは勾配降下法を使用します。Mahonyは制御理論に基づいており、Madgwickは最適化に基づいています。両者とも計算コストは似ています。Mahonyは通常、バイアスの収束が速く、Madgwickは実装がより単純です。姿勢のみ(バイアスなし)の場合、両者の性能は似ています。

Mahonyは大きな加速度に対応できますか?

大きな加速度の間、加速度計は慣性加速度と重力を測定するため、ピッチ/ロール誤差が発生します。Mahony Filterは加速度計が下を向いていると仮定しますが、大きな加速度はこの仮定に反します。一部の実装では、操縦中の加速度計の重みを減らすために加速度の大きさの閾値処理を使用し、ロバスト性を向上させています。

関連する手法

参考文献

  1. Mahony, R., Hamel, T., & Pflimlin, J. M. (2008). Multirotor aerial vehicles: Modeling, estimation, and control of quadrotors. IEEE Robotics and Automation Magazine, 19(3), 20–32.

    出版物の文献を開く
    コピーしました。
  2. Mahony, R., Hamel, T., & Pflimlin, J. M. (2012). Multirotor aerial vehicles: Modeling, estimation, and control of quadrotors. IEEE Robotics & Automation Magazine, 19(3), 20–32.

    DOI 文献を開く
    コピーしました。
  3. Valenti, R. G., Dryanovski, I., & Xiao, J. (2016). Keeping a good attitude: A quaternion-based orientation filter for IMUs and MARGs. Sensors, 15(8), 19302–19330.

    DOI 文献を開く
    コピーしました。