加速度計は重力感知で線形加速度と傾きを測定し、ジャイロスコープは角速度を追跡しますが、どちらも単独では数秒以上うまく機能しません。加速度計は位置に積分するとドリフトし、ジャイロスコープはバイアスオフセットによる角度誤差を蓄積します。以下では、これらのセンサーが実際のシステムでどのように振る舞うのか、その仕様が重要な点、そして融合アルゴリズムがどのようにそれらを有用に保つのかを解説します。
主なポイント:
- 加速度計は重力参照による傾き角度を即座に示しますが、加速度と加速度を統合すると、音やバイアス誤差が毎段階倍増します。
- ジャイロスコープは短期間で回転をきれいに測定しますが、補正しなければ0.1°/sのバイアスが1分あたり6°のドリフトに複合します。
- 3軸のアライメントはパッケージのマーキングではなく、ダイ内部で定義されます。データシートの軸図を誤読すると座標系全体が回転してしまいます。
- 静止時のゼロバイアスのキャリブレーションは譲れません。温度ドリフトにより、そのゼロ点は10〜50 mg(加速度計)または0.5〜2°/s(ジャイロスコープ)も動作範囲内でずれます。
- センサーフュージョンはオプションの仕上げではなく、これらの装置が実験デモを超えて動作する唯一の理由です。なぜなら、加速度計がジャイロのドリフトを修正し、ジャイロスコープが動作中の加速度計ノイズを排除できるからです。
加速度計が運動と重力を測定する方法
加速度計は比力を報告し、これには実際の加速度と地球の重力による一定の1gの引力が含まれます。つまり、テーブル上の固定加速度計は垂直軸で+1 gを表示し、ゼロではなく、最初の積分のたびに誤る細部となります。
重力ベクトルから直接傾きを抽出できるので、加速度計は長期的な向きの基準として機能します。しかし、加速度を速度に統合し、位置を測定するノイズやバイアスを各タイムステップで組み込もうとすると、私の経験では、低ノイズのMEMSユニット(+/- 0.1 mgのノイズ密度)でも、他のリファレンスと融合しなければ、10秒後に数メートルのファントム変位が生じます。
教科書の計算は明確に見えます:速度を1回、位置を2回積分します。実際には、直流バイアスと1/fノイズが数秒でそのチェーンを壊してしまいます。
MEMS 加速度計の構築
現在のほとんどの加速度計は、シリコンスプリングで懸浮する微小な証明質量を使用しています。センサーが加速すると、慣性により質量が遅れ、差動コンデンサペアのギャップが変化します。この静電容量シフトは電荷増幅器を介して電圧に変換されます。
この容量感知のため、MEMS加速度計は機械的応力やパッケージのひずみに敏感です。基板の曲がりは基準容量をずらし、偽の加速度として現れます。加速度計では、密度の高いPCB上の取り付けネジが過度にねじれただけで+50mgのオフセットが報告されているのを見たことがあります。
全体の構造は平方ミリメートルに収まるため、3軸加速度計と3軸ジャイロスコープは、アナログフロントエンドとデジタルインターフェースロジックを共有する3×3mmパッケージに共存しています。
ジャイロスコープ回転感知
ジャイロスコープは角速度を角度ではなく、毎秒(またはラジアン毎秒)で出力します。向きを回復するには、その速度を時間とともに積分しなければならず、そのためバイアス誤差は線形に積み重なり角度ドリフトになります。
例えば、+0.1°/sの定数バイアスを持つジャイロスコープは、静止していても1分で6°、1時間で360°ドリフトします。だからこそ、ジャイロスコープは加速度計の重力ベクトルや磁力計の北方方向のような絶対基準から頻繁に補正する必要があります。
ジャイロスコープの強みは、回転に即座に反応し、線形加速度、振動、傾斜に惑わされない点にあります。これらは運動中に加速度計のみの向き推定を台無しにする問題です。ジャイロスコープは短期的な力学をクリーンに示します。加速度計は長期的な安定性を提供します。どちらも単独ではうまくいきません。
MEMSジャイロスコープにおけるコリオリ効果
MEMSジャイロスコープはコリオリ効果に依存しています。すなわち、証明質量が一つの軸(駆動軸)に沿った共振振動に駆動されます。センサーが回転すると、コリオリ力により振動質量が垂直な感覚軸に沿って偏向します。その偏向の振幅は角速度に比例します。
この設計により、MEMSジャイロスコープは実際には動的装置であり、動作するために連続駆動振動が必要です。機械的な衝撃や温度変化によって駆動共鳴がずれると、駆動ループが再びロックされるまで感度が低下します。20°Cの温度変動でジャイロ出力が15%減少したシステムもデバッグしたことがあります。これはドライブ周波数が温度補償されていなかったからです。
コリオリ信号は非常に小さく(しばしばフェムトファラドレベルの容量変化)、ジャイロスコープは加速度計よりもノイズフロアが高く、電磁干渉や電源のリップルに対してより脆弱です。
センサー軸の定義と取り付け
すべての加速度計およびジャイロスコープのデータシートには軸向き図が含まれており、通常はピン1やパッケージエッジに対するX、Y、Z矢印を示します。その図は真実です――パッケージの輪郭対称性は無視してください。
生産用ファームウェアでは、PCB設計者が加速度計の軸がチップの正方形の輪郭と一致していると仮定し、実際には内部MEMSダイが回転していたため、すべてのモーションデータを90°回転させてしまうのを見たことがあります。その結果、「ピッチ」が「ロール」に、その逆が起こり、基本的な電源オンチェックは通過しましたが、機器が傾いた瞬間に失敗しました。
3軸センサーは直交軸に沿って測定しますが、その軸はシリコンエッチングによって定義され、チップの取り付け方法によって決まります。機械アセンブリで軸のずれが生じた場合(例えば、基板スペースを節約するために6軸IMUを5°傾けて取り付けるなど)、ソフトウェアで回転マトリックスを適用するか、5°の軸の誤差を受け入れる必要があります。
データインターフェースと信号経路
ほとんどの現代の加速度計やジャイロスコープは、I²CまたはSPIを介してデジタルデータを出力します。I²Cは速度が遅く(通常最大400 kHzで、実際にはサンプルレートは約200〜400 Hzに制限されます)、2本の線のみを使用し、マルチドロップに対応しています。SPIはより高速(10+ MHz、1+ kHzのサンプルレートを可能にする)が、専用のチップセレクトと4本の線が必要です。
多くのIMU(統合加速度計+ジャイロスコープ)にはFIFOバッファ(通常512〜1024サンプル)が含まれており、ホストプロセッサはフルサンプルレートでポーリングするのではなく、バーストでデータを読み取ることができます。これにより電力と割り込み負荷が削減されますが、FIFOのウォーターマークを監視しないとバッファオーバーフロー時にサンプルが失われます。
一部のIMUには、動きが閾値を超えたときやFIFOが一定レベルに達したとき、またはセンサーがフリーフォールやタップイベントを検知したときにアサートするプログラム可能な割り込みピンも備えています。これらの機能は低消費電力のモーション上ウェイク設計には有用ですが、しきい値ロジックは精密なモーションキャプチャには粗すぎることが多いです。
主要仕様とそれが実際に意味するもの
測定範囲は、クリッピング前にセンサーが報告できる最大加速度または回転速度を設定します。加速度計の一般的な範囲は±2 g、± g、±8 g、±16 gです。ジャイロスコープの場合、±250°/s、±500°/s、±1000°/s、±2000°/sです。広いレンジは解像度を下げますが、衝撃や高速回転時の飽和を防ぎます。
ハンドヘルドデバイスでは、±4 g加速度計と±500°/sのジャイロスコープで通常十分です。ドローンや高振動環境では、エンジン始動や激しい操作時に±4gでクリップするため、±8gや±16gの方が安全です。
ノイズ密度はμg/√Hz(加速度計)または°/s/√Hz(ジャイロスコープ)で指定されます。信号帯域幅の平方根に掛ければ、RMSノイズが得られます。例えば、50 Hz帯域幅で測定したジャイロスコープの雑音密度が0.01°/s/√Hzの場合、0.01 × √50 ≈0.07°/s RMSノイズが得られます。
ノイズを下げることは、スローモーションや細かい角度の解像度に重要です。高ノイズは積分後にドリフトに流され、ノイズの多いジャイロスコープは同じバイアスの静かなジャイロスコープよりも角度精度をさらに早く失います。
バイアス(ゼロレートオフセットまたはゼロGオフセットとも呼ばれる)は、動きが存在しないときのセンサー出力です。加速度計の場合、バイアスはmgで指定されます。ジャイロスコープの場合は、°/sで表記されています。バイアスは一定ではなく、温度、供給電圧、機械的応力、時間とともに変化します。
電源オン時にセンサーが静止している間に100〜200サンプルを平均してバイアスを測定し、そのオフセットを将来の測定値から差し引いています。しかし、動作中にデバイスが30°C加熱されると、部品グレードによってさらに10〜50 mg(加速度計)または0.5〜2°/s(ジャイロスコープ)ずれます。そのため、高級IMUには内部温度センサーが内蔵され、工場出荷時の校正表を保存してバイアスと温度を補正します。
温度ドリフトは、摂氏度あたりのバイアスの変化です。0.03°/s/°Cのジャイロスコープでは、30°Cの温度上昇は0.9°/sのドリフトを加え、これは良好なゼロキャリブレーションの初期バイアスの9倍となります。加速度計は影響が少なく(通常0.3〜1 mg/°C)、しかし精密傾斜用途では依然として重要です。
ある自動車プロジェクトでは、IMUが数分ごとに40°Cをサイクルするパワートランジスタの近くに設置されていました。ジャイロスコープのゼロレートが定常走行中の実際の回転速度よりも速くドリフトしたため、カルマンフィルター状態を用いた連続バイアス再推定を実行しなければなりませんでした。
校正手順
最低限、使用前に加速度計とジャイロスコープの両方のゼロバイアスを校正する必要があります。デバイスを安定した表面に置き、軸ごとに200+サンプルを集め、平均値を計算し、そのオフセットを将来の測定値から差し引きます。
加速度計の場合、重力の影響で一方の軸は+1 g(または-1 g)を示すことを覚えておいてください。その軸をゼロにしないでください。代わりに、測定値から期待重力成分を引いてください。もしZ軸がデバイスが平らな状態で+1.02 gを表示しているなら、バイアスは+0.02 gで、+1.02 gではありません。
ジャイロスコープは静止している間、すべての軸でほぼゼロを読み取るべきです。ゼロでない平均はバイアスです。
より高度なキャリブレーションには以下が含まれます:
- スケールファクター補正:実際の感度が公称値と1〜3%異なる場合があります。ジャイロスコープ用に既知の角度でセンサーを回転させるか、加速度計用に+1gや-1gを回転させてゲイン誤差を測定します。
- 軸のずれ補正:3つの軸が完全に直交していない。完全な9パラメータキャリブレーションマトリックスでこれを補正できますが、実験機器や精密ターンテーブルが必要です。
- 温度補償:バイアスと温度をルックアップテーブルに保存し、実行時に補間します。
私は、アプリケーションがサブディグリー精度を求めない限り、生産設計でフル9-DOFキャリブレーションを行うことはほとんどありません。なぜなら、複雑さやテスト時間が増えたとしても、その分正当化が難しいからです。ゼロバイアスとスケールファクター補正は、実際の誤差の90%をカバーします。
センサー融合:なぜ両方が必要なのか
加速度計は重力基準に基づく垂直方向を提供しますが、ノイズが多く、振動や直線加速度(重力以外の加速度は傾きのように見える)によって簡単に乱されます。ジャイロスコープはクリーンで高速な回転トラッキングを提供しますが、時間とともにドリフトします。
センサー融合は両者を組み合わせています。ジャイロスコープを使って高速度(100 Hzから1 kHz)で向きを伝播させ、加速度計の重力ベクトルを使って定期的に向き推定値を補正します。最も一般的なアルゴリズムは補完フィルターです:
角度 = 0.98 ×(角度 + ジャイロ × dt)+ 0.02 × accel_angle
つまり、アップデートの98%はジャイロスコープの統合によるもので、2%は加速度計の傾き測定によるものです。その結果、ジャイロスコープのように動きに素早く反応しつつも、時間とともにずれない(加速度計の基準のように)方向推定が得られます。
より高度なシステムはカルマンフィルターまたは拡張カルマンフィルター(EKF)を使用し、推定されたセンサーノイズや信頼度に基づいて重み付けを動的に調整します。高速加速度や振動時には、フィルターが加速度計への信頼を低下させます。定常運動中は、ジャイロドリフトを抑制するために補正利得を増加させます。
核融合がなければ、加速度計からのノイズの傾きとジャイロスコープからの無制限のドリフトという、両方の悪い結果が起こります。私が出荷したすべてのモーショントラッキング製品――ゲームコントローラーからIMUモジュールまで――は、使用可能であるためにフュージョンが必要でした。
よくある問題とデバッグ
センサーが静止している間に一定の非ゼロ加速度や回転を読み取りた場合、ゼロバイアスをキャリブレーションしていません。定常データセットを収集し、平均を差し引きます。
もし方向推定値が一方向にずれ続けるなら、ジャイロバイアスの補正が機能していません。バイアス値が間違っているか、サンプルレートが間違っている(つまりdtが間違っている)、あるいはキャリブレーション後に温度がバイアスをずらしているかのどちらかです。
もし傾き角度が90°跳ねたり反転したりするなら、おそらく軸のマッピングが間違っているのでしょう。データシートの軸図に戻り、符号の慣習を確認してください。
データがノイズが多く、周期的にスパイクがある場合は、電源のデカップリングをチェックしてください(センサーの近くに0.1μFのセラミックと10μFのタンタルを追加)、SPIクロックエッジがデータシートのタイミングと一致しているか、サンプルレートがセンサー内部出力データレートより高くならないか確認してください(ODRより速く読み上げると前のサンプルを繰り返すか、古いFIFOデータを返すだけです)。
センサーが反応しなくなったりすべてゼロを返した場合は、I²Cのプルアップ(通常4.7 kΩ)をチェックし、チップのI²Cアドレスがコードと一致しているか(多くのIMUはピンで2つのアドレスが選択可能)と一致するか、VDDIOがMCUの論理レベル(1.8 V、3.3 V、または5 V)と一致しているか確認してください。3つの別々の設計をデバッグしましたが、3.3V I/Oは常に互換性があると思われていたものの、センサーは1.8V VDDIOを必要とし、3.3V MCUが入力をオーバードライブしていました。
正確さを本当に制限するもの
ほとんどのシステムでは、制限要因はセンサーのノイズ仕様ではなく、バイアスの不安定性と温度ドリフトです。0.5°/sでドリフトするジャイロスコープは1分間で30°の誤差を蓄積し、これは0.07°/sのRMSノイズフロアをはるかに上回ります。
機械的な取り付けも重要です。ある設計では、加速度計がPCBのたわみ点の近くに位置し、エンクロージャーを押すたびに基板が反り、+20mgの偽Y軸加速度が加わりました。センサーを基板のより硬い部分に移すと、幻の信号は消えました。
振動はセンサーが高衝撃に耐えられるものであっても加速度計に連動します。共振時(基板上のMEMSダイは通常1〜5kHz)では、振幅の低い振動でも信号帯にエイリアスが下がり、実際の加速度のように見えます。自動車や産業用途で、近くのモーターやポンプが2kHzの振動を発生させ、それが100Hzの測定帯に折りたたまれ、50+mgのノイズを加えるのを見たことがあります。
解決策は機械的絶縁(ゴム製ダンパーやフォームスペーサー)か、より優れたローパスフィルタリングですが、まず振動周波数を特定する必要があります。生加速度計データのスペクトル解析で犯人は通常特定できます。
加速度計やジャイロスコープだけでは足りないとき
加速度計+ジャイロスコープ融合は短期的な方位(数秒から数分)には有効ですが、垂直軸の方向ドリフトを修正することはできません。もし装置がゆっくりヨーで回転している場合(例えば静止しながら旋回するなど)、ジャイロスコープはドリフトし、加速度計は重力が垂直であるため変化を感知しません。
そのため、9軸IMUは地球の磁場を感知し絶対方位基準を提供する磁力計を追加しています。しかし磁力計は、近傍の鉄系物質や直流電流、モーターやバッテリーからの磁場によって簡単に影響を受けやすく、新たな校正や誤り訂正の問題を引き起こします。
長期的な位置や絶対方向が必要な用途では、最終的に外部の基準が必要になります。位置を示すGPS、相対運動を示す視覚的オドメトリー、または方向を示す固定ビーコンです。加速度計やジャイロスコープは高速の局所運動を得て、グローバルな真実ではありません。
デバイスグレードの選択
MEMS加速度計やジャイロスコープは、消費者向け、産業用、戦術用のいずれかのグレードがあります。消費者向け部品(携帯電話やフィットネストラッカーなど)は、ジャイロで0.1〜0.5°/s、加速で1〜10 mgのバイアス不安定性があり、温度ドリフトは最大0.05°/s/°Cに達します。
産業用IMUは、ジャイロ時のバイアスを0.01〜0.05°/s、加速度時0.1〜1 mgに改善し、内部温度補償や長期安定性の向上も伴います。これらは3〜10×高くかかりますが、ロボティクス、UAV、または精密プラットフォームの安定化には価値があります。
戦術グレードおよび航法グレードのセンサー(航空宇宙や防衛で使用)は、MEMSではなく光ファイバーやリングレーザージャイロスコープを用いるため、0.001°/s以下のバイアスに達します。1軸あたり数千ドルのコストがかかり、熱制御や振動制御も慎重で、慣性航法システム以外の用途では過剰です。
ほとんどの組み込みプロジェクトにおいて、中堅の産業用MEMS IMUはコスト、性能、統合の努力のバランスを取っています。
