Skip to content
検索結果に戻る

AHRS

提唱者
Aviation heritage
年
1940s
種類
System
系統
Attitude Estimation

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

文字サイズ

何をする手法か?

姿勢方位基準装置(AHRS)は、車両やプラットフォームの三次元の姿勢(attitude)と方位(heading)を推定し出力する、完全な慣性航法サブシステムです。AHRSは、加速度計、ジャイロスコープ、そしてしばしば磁力計からの測定値を、センサーフュージョンアルゴリズム(通常はカルマンフィルターまたは相補フィルター)を介して組み合わせることで、ドリフトのない高速な姿勢推定を提供します。AHRSは、航空、海上航法、および現代の自律システムにおいて標準的に使用されています。

手法の背後にある直感

ジャイロスコープは回転速度を直接測定し、短期間(数秒)では正確ですが、時間とともにドリフトします(ノイズとバイアスの積分)。加速度計は重力を感知し、長期的には安定していますが、ノイズが多く、水平方向の回転を直接測定することはできません。コンパス(磁力計)は地球の磁場に対する方位を測定しますが、局所的な歪みの影響を受けます。AHRSはこれら3つすべてを融合し、それぞれの長所を活用します。すなわち、即応性にはジャイロ、長期的な安定性には加速度計とコンパスを利用します。

歴史学

機械式ジャイロスコープを使用した航空機の姿勢基準は1920年代(Sperry)に遡ります。現代の電子AHRSは、ソリッドステートセンサーの出現により1970年代から1980年代にかけて登場しました。1990年代から2000年代にかけての微小電気機械システム(MEMS)ジャイロスコープ、加速度計、磁力計の統合により、小型で低電力のAHRSが可能になりました。2010年代のアルゴリズムの進歩(Madgwickフィルター、Mahonyフィルター)により、最小限の計算コストで正確な姿勢が可能になり、家電製品やUAVでの採用が促進されました。

使うべき場面

リアルタイムでドリフトのない姿勢および方位情報が必要な場合は常にAHRSを使用してください。航空機のオートパイロット、海上航法システム、UAV、ロボット、モバイルデバイスに不可欠です。AHRSは、飛行制御、安定化、および航法システムの基盤となります。ドリフトやノイズのために個々のセンサー測定値(ジャイロ単独、コンパス単独)では不十分な場合にAHRSを導入してください。視覚ベースの姿勢とは異なり、あらゆる天候および照明条件で使用できます。

限界と注意点

  • 磁力計の擾乱。局所的な磁気異常(鉄骨構造物、電気システム、車両電子機器)は方位精度を低下させます。補償または再校正が必要です。
  • 大きな加速度。操縦中、加速度計は重力加速度と慣性加速度の両方を測定するため、ピッチ/ロール誤差が発生します。フィルターは運動モデルを使用してこれを軽減する必要があります。
  • ジンバルロック(オイラー角の場合)。90度のピッチでの特異点は、慎重な数値処理を必要とします。クォータニオン表現はこれを回避します。
  • 初期化。姿勢を初期化するために、システムは起動時に静止している(または既知の運動をしている)必要があります。動的な初期化は複雑です。

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

強み

  • 長期間にわたってドリフトがない。安定しているがノイズの多いセンサー(加速度計、コンパス)と、ドリフトしやすいが高速なセンサー(ジャイロ)の融合により、安定した応答性の高い姿勢推定が得られます。
  • リアルタイム計算。フィルターはセンサーレート(100+ Hz)で動作し、タイトな制御ループを可能にします。
  • 外部参照は不要。自己完結型で、屋内でも屋外でも、昼夜を問わず機能します。
  • 一時的なセンサーノイズに堅牢。フィルターは応答性を維持しながら、測定値のスパイクを自然に平滑化します。

応用

  • 航空機のオートパイロットと飛行制御:航空機の姿勢と方位を維持し、オートパイロットアルゴリズムに入力を提供します。
  • 無人航空機(UAV)の安定化:クアッドコプターおよび固定翼UAVの飛行制御を可能にします。
  • 海上航法と安定化:オートパイロットと航法のための船の方位基準。横揺れ防止安定化への入力。
  • 移動ロボットと車輪付き車両の誘導:地形航法のための方位とピッチ/ロールを提供します。
  • スマートフォンとウェアラブル拡張現実:ARディスプレイとジェスチャー認識のための向き追跡を可能にします。

使い方

使い方

1

9自由度(9-DOF)慣性計測装置(IMU)から高レートの測定値(3軸加速度計、3軸ジャイロスコープ、3軸磁力計)を収集します。通常、50~200 Hzで取得します。

2

静的または既知の運動校正を用いて、センサーのバイアス、スケールファクター、およびミスアライメントを校正します。磁気歪みを除去または補償し、測定値に正確なタイムスタンプを付与します。

3

加速度計と磁力計(ベクトル測定)をジャイロスコープ(レート測定)と、オブザーバーベースのフィルター(相補フィルターまたはカルマンフィルター)を使用して融合し、クォータニオン姿勢を推定します。オイラー角(ロール、ピッチ、ヨー)または直接余弦行列表現を計算します。

数式
\vec{q}(t+dt) = \vec{q}(t) + \frac{1}{2}\vec{\omega} \times \vec{q}(t) \cdot dt
4

状態推定値(クォータニオンまたはDCM)と共分散を維持します。ジャイロスコープの積分を介して状態を伝播させ、ノイズ共分散とダイナミクスモデルによって重み付けされた加速度計とコンパスの測定値で更新します。

5

リアルタイムの姿勢(ピッチ、ロール、ヨーまたはクォータニオン)と方位(磁気方位または偏角補正後の真方位)を出力します。信頼度または精度指標を報告し、磁気擾乱またはセンサー故障をフラグ付けします。

よくある落とし穴

  • 磁気校正の無視。未校正の磁力計は5~10度以上の方位誤差を引き起こします。常に運用環境で校正してください。
  • フィルターゲインの調整不良。修正が速すぎると方位のジッターが発生し、遅すぎるとドリフトが発生します。経験的な調整または適応的な方法が必要です。
  • 磁気方位と真方位の混同。磁気偏角は場所によって異なります。アプリケーションに適したバリアントを出力してください。
  • 加速度計が常に下を向いていると仮定すること。高速操縦中、加速度計は傾いており、姿勢には使用できません。フィルターは適応する必要があります。

よくある質問

ジンバルロックとは何ですか、またそれを回避するにはどうすればよいですか?

ジンバルロックは、ピッチが90度に達したとき(例:機首が真上または真下を向いているとき)に発生します。この特異点では、ロールとヨーが従属的になり、1自由度が失われます。内部計算にはオイラー角の代わりにクォータニオン表現を使用することで回避できます。表示のためだけにオイラー角に変換してください。クォータニオンは特異点フリーです。

動的な動き中にAHRSの姿勢を初期化するにはどうすればよいですか?

静的初期化(1~2秒間静止させる)が最も簡単です。動的初期化の場合、既知の操縦または低加速度を仮定する運動モデルを使用して、より長い観測ウィンドウ(5~10秒)を使用します。一部のシステムでは、GPS速度を使用して運動モードを検出し、適切な初期化を適用します。

AHRSにおける相補フィルターとカルマンフィルターの違いは何ですか?

相補フィルターはヒューリスティックで調整が簡単です。ジャイロレートをハイパスフィルター処理し、加速度計/コンパスをローパスフィルター処理します。カルマンフィルターは線形システムに最適であり、異なるセンサーの不確実性を自然に処理します。カルマンフィルターはより堅牢ですが、計算負荷が高くなります。ほとんどのアプリケーションでは、相補フィルターで十分です。

AHRSで磁気擾乱を検出して修正するにはどうすればよいですか?

磁力計の読み取り値に異常(大きさの変化、予想される磁場からのずれ)がないか監視します。コンパス方位を慣性推定値と比較し、大きな不一致は擾乱を示します。軽減策としては、擾乱中にGPS速度からの方位推定値を使用する、ソフトアイアン/ハードアイアン校正を適用する、またはフィルター内のコンパスの重みを減らすなどがあります。

関連する手法

参考文献

  1. Savage, P. G. (2007). Strapdown Inertial Integration Technology (2nd ed.). Strapdown Associates.

    出版物の文献を開く
    コピーしました。
  2. Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.

    DOI 文献を開く
    コピーしました。
  3. 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.

    出版物の文献を開く
    コピーしました。