Madgwick Filter
- 提唱者
- Sebastian Madgwick
- 年
- 2010
- 種類
- Filter algorithm
- 系統
- Gradient Descent Filtering
この文章は機械翻訳で、まだ確認されていません。 英語の原文を読む
何をする手法か?
Madgwick Filterは、加速度計、ジャイロスコープといった慣性計測と、磁力計といった磁気計測を融合してクォータニオンによる姿勢を推定する、計算負荷の軽いアルゴリズムである。2010年にSebastian Madgwickによって導入されたこのアルゴリズムは、勾配降下法最適化を用いて、計測されたセンサ出力と期待されるセンサ出力との誤差を最小化し、計算コストを最小限に抑えながら、組み込みシステム上で高精度かつドリフトフリーな姿勢推定を実現する。Madgwick Filterは現在、民生用電子機器、ロボット工学、航空宇宙システムに広く普及している。
手法の背後にある直感
そのアイデアは、観測されたセンサ測定値を最もよく説明するクォータニオン(姿勢)を見つけることにある。加速度計とコンパスは重力と磁北の方向を示し、ジャイロスコープは回転速度を示す。このアルゴリズムは、推定されたベクトルと計測されたベクトルを近づける姿勢調整の方向(勾配)を計算し、その方向にわずかにステップを進める。これを毎秒何度も繰り返すことで、ドリフトしない滑らかでリアルタイムな姿勢推定が得られる。
歴史学
Sebastian Madgwickは、モーションキャプチャと人間の運動分析の研究中に、2010年頃にこのアルゴリズムを開発した。このアルゴリズムは2011年にIEEE International Conference on Rehabilitation Roboticsで発表され、オープンソースコードとしてリリースされた。そのシンプルさと有効性から、DIYロボットおよびメイカーコミュニティで急速に採用された。主要な民生用電子機器企業(スマートフォン、VRヘッドセット、フィットネストラッカー)がバリアントを採用した。Madgwick Filterは、組み込みシステムや教育分野で人気があり、学生向けのセンサフュージョンの入門としてよく利用されている。
使うべき場面
軽量でリアルタイムな姿勢推定をリソース制約のあるデバイス(マイクロコントローラ、携帯電話、ウェアラブル)で必要とする場合にMadgwick Filterを使用する。Kalman Filterの複雑さが過剰であるアプリケーションに最適である。屋内および屋外、車両、ドローン、ウェアラブルで効果的である。9軸IMUを持ち、複数のKalman Filterパラメータのチューニングを避けたい場合に展開する。民生用電子機器、ホビーロボット、リアルタイム制御システムに使用する。
限界と注意点
- ヒューリスティックであり、最適ではない。Kalman Filterとは異なり、正式なコスト関数を最小化しない。
- パフォーマンスはbeta(ステップサイズ)に決定的に依存する。センサの品質や運動が変化しても自動適応しない。
- 磁力計の摂動がヨーを破損させる可能性がある。手動キャリブレーションが必要。不良測定値を自動検出または拒否しない。
- 大きな加速度(MARGバリアント)は、加速度計が重力とずれるため一時的な誤差を引き起こす。フィルタの回復はヒューリスティックであり、原理的ではない。
出典に示された条件は、独立した科学的レビューや分析エンジンによる検証の代わりにはなりません。
強み
- 計算コストが最小限である。100行未満のコードで実装され、マイクロコントローラやモバイルプロセッサで実行される。
- 行列や複雑な線形代数は不要。クォータニオン代数と内積のみが必要。
- IMUのみ(6-DOF)とMARG(9-DOF)のバリアントを提供し、利用可能なセンサに適応可能。
- 単一のチューニングパラメータ(beta)によりカスタマイズが容易。共分散行列や行列の逆算は不要。
応用
- スマートフォンおよびウェアラブルのモーション追跡:重い計算なしでモーションジェスチャー認識と拡張現実を可能にする。
- クアッドコプターおよびドローンの安定化:リソースが限られたオートパイロットでの飛行制御のためのロール、ピッチ、ヨー推定を提供する。
- 仮想現実(VR)ヘッドセットのモーション追跡:没入型ディスプレイのためのリアルタイムヘッドオリエンテーション。
- モーションキャプチャおよび人間のアニメーション:歩行分析およびアニメーションのための体節のオリエンテーションを追跡する。
- ロボット工学およびホビードローン:Arduino、Raspberry Pi上の姿勢推定のためのKalman Filterの軽量代替。
使い方
使い方
9軸IMU(3軸加速度計、3軸ジャイロスコープ、3軸磁力計)から50Hz以上で測定値を収集する。
加速度計と磁力計のベクトルを単位長に正規化する。ジャイロスコープの生レートベクトルを格納する。既知のセンサキャリブレーション(バイアス、スケールファクタ)を適用する。
クォータニオンに関する測定誤差の勾配を計算する。誤差を最小化する方向(勾配降下)にクォータニオンをステップさせる。ジャイロスコープレートを積分してクォータニオンの進化を予測する。
数式
\nabla f = \frac{\partial f}{\partial \vec{q}}勾配降下補正とジャイロスコープ積分を単一パラメータ(beta)でブレンドし、補正強度を制御する。各更新でクォータニオンを出力する。
クォータニオンをオイラー角(ロール、ピッチ、ヨー)に変換するか、クォータニオンを直接使用する。姿勢を報告し、センサの信頼性と運動状態に基づいて信頼性を評価する。
よくある落とし穴
- betaが高すぎると急激な振動や発散を引き起こし、低すぎると応答が鈍くなる。典型的な範囲は0.01~0.1で、経験的にチューニングされる。
- 磁力計キャリブレーションの無視。ソフトアイアンおよびハードアイアンの歪みはヨー誤差を引き起こす可能性がある。正確なヨーのためにはキャリブレーションが重要。
- 加速度計が常に有効であると仮定すること。激しい加速中、加速度計はロール/ピッチ推定に使用できない。一部のアルゴリズムは、操作中に加速度計を検出して無視する。
- 初期化なしでの展開。アルゴリズムは数秒で収束するが、車両が静止している状態(静的初期化)で初期化するのが最善である。
よくある質問
betaパラメータの選択方法は?
Betaは勾配降下補正のレートを制御する。Madgwickが使用した値であるbeta = 0.041から始める。フィルタの応答が遅い(動きへの応答が遅い)場合は、betaを増やす(最大0.1~0.5)。フィルタが振動またはドリフトする場合は、betaを下げる(0.01まで)。既知の動きに対する姿勢応答を観察して経験的にチューニングする。
IMU(6-DOF)とMARG(9-DOF)バリアントの違いは何ですか?
IMUバリアントは加速度計とジャイロスコープのみを使用する。ロールとピッチを提供するが、ヨーは基準なしではドリフトする。MARGバリアントは絶対ヨーのために磁力計を追加する。安定した3-DOF姿勢を提供するが、磁気摂動に敏感である。短時間の飛行にはIMUを使用し、静止または低速ナビゲーションにはMARGを使用する。
32ビットマイクロコントローラでMadgwick Filterを実行できますか?
はい。このアルゴリズムは非常に効率的であり、ARM Cortex-M4は200Hz以上で実行できる。8ビットマイクロコントローラ(浮動小数点ライブラリ付き)でも50Hz以上を処理できる。パフォーマンスはクロックレートと浮動小数点サポートに依存する。固定小数点演算を使用すると、さらに低速なプロセッサにも対応できる。
磁気摂動を検出するにはどうすればよいですか?
磁力計の大きさを監視する。地球磁場は約50マイクロテスラである。それ以上の偏差は摂動を示す。コンパスのヨー(磁力計から)とジャイロ積分からのヨーを比較する。大きな不一致は摂動を示す。緩和策:摂動中に一時的に磁力計の更新を無視するか、その重みを減らす(一部のバリアントではbeta_mを下げる)。
関連する手法
参考文献
Madgwick, S. O. H., Harrison, A. J. L., & Vaidyanathan, R. (2011). Estimation of IMU and MARG orientation using a gradient descent algorithm. IEEE International Conference on Rehabilitation Robotics (ICORR), 1–7.
出版物の文献を開くコピーしました。Madgwick, S. O. H. (2010). An efficient orientation filter for inertial and inertial/magnetic sensor arrays. Report x-io Technologies, University of Bristol, UK.
出版物の文献を開くコピーしました。Sabatini, A. M. (2006). Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing. IEEE Transactions on Biomedical Engineering, 53(7), 1346–1356.
DOI 文献を開くコピーしました。