ヒューマノイド状態推定は、歩行制御では直接測定できない浮遊する基本姿勢、速度、IMUバイアス、接触状態を再構築します。関節エンコーダは機構を内部的に記述しますが、骨盤や足を外部または接触に基づく制約なしに世界に配置することはありません。
IMUは高速角速度と比力を提供しますが、積分によってバイアスやノイズが蓄積されます。フットキネマティクスは接触点が固定されている間にドリフトを修正できます。同じアップデートは、足が滑ったり、揺れたり、誤ってサポートと分類された場合に有害になります。
このガイドは IMUバイアスおよびキャリブレーションガイド および 座標系ガイドと併用してください。推定量の整合性とバランス制御への影響を評価し、ポーズ誤差だけではなく。
状態と各出力契約を定義します
典型的な状態には、基底の向き、位置、速度、ジャイロスコープのバイアス、加速度計のバイアス、そして1つ以上の接触点が含まれます。一部のシステムは重力の方向、足の向き、センサーのスケールや地形パラメータも推定します。状態の選択によって、何が観察され、どの誤りが修正可能かが決まります。
タイムスタンプ、フレーム、共分散、コンタクトの信頼度、妥当性を数値状態と公開します。データ年代や不確実性のない新鮮なポーズを受信したコントローラーは、良好な推定値と遅延や劣化した動作を区別できません。
IMUモデルで国家を拡散する
ジャイロスコープは向きを伝播し、加速度計の比力は回転し重力と組み合わさって速度と位置を伝播します。バイアス、スケール、軸の整列、温度、振動がこの予測に直接影響します。小さな持続的な誤りは統合を通じて成長します。
キャリブレーション済みのユニットと、ドキュメント化されたIMUからベースへの変換を使いましょう。測定値を取得時に適用し、共分散の成長を維持し、高い更新率が低周波バイアスを取り除くと見せかけないようにしましょう。
| 入力または状態 | 提供 | 支配的リスク | 検証エビデンス |
|---|---|---|---|
| ジャイロスコープ | 角速度伝搬 | バイアスと振動 | 静的および運動残差 |
| 加速度計 | 比比力伝播 | 重力誤差とスケール誤差 | 向きスイープ |
| ジョイントエンコーダ | ベース・トゥ・フットの運動学 | ゼロとコンプライアンス誤差 | 運動学的閉鎖 |
| 足の接触 | 世界制約 | スリップまたは偽サポート | 力と運動の証拠 |
| 外姿勢 | グローバル補正 | レイテンシとフレームバイアス | 時限残差 |
関節運動学を使ってベースと足をつなげてください
エンコーダー測定とロボットモデルは、浮動基座と各フィート間の変換と速度を提供します。足が世界に固定されている場合、その相対運動が基底速度と姿勢を制約します。モデル誤差や構造適合性はこの補正の精度を制限します。
ジョイントのゼロ点、リンク寸法、軸方向、荷重下の足部フレームを確認してください。シミュレーションで閉じる運動連鎖は、単一支持時にソールが圧縮されたり構造がしわんだりするとずれることがあります。
接触は完全なスイッチではなく確率として扱う
着陸と離陸には時間がかかり、部分的な接触は有効な支持点を動かすことがあります。計画的な歩行段階と、力、運動学、足の動きの証拠を組み合わせます。ヒステリシスや滞留は閾値付近での急速な切り替えを防ぐことができます。
各接触点に別々の信頼度と共分散を関連付けてください。2回の力の読み取り値が名目数値を超えたからといって、移行中に両足を完全に固定してはいけません。
接触支援フィルター補正を一貫して適用する
接触補助推定器は接触ランドマークを追加または起動し、予想される静止足の動きを使って伝播状態を修正します。 Contact-Aided Invariant EKFの論文 はこの定式化を開発し、脚付きロボットの可観測性を解析しています。
実装には明示的なノイズ、接点の作成・除去、タイムスタンプの処理、フレーム定義が必要です。フィルターの整合性と平均誤差を比較してみてください。推定量は数値的に滑らかでありながら、不当に自信を持つことができます。
滑ったり揺れた接点を拒否したりする
フィルターが固定していると仮定している間に支持足が動くと、推定されるベースは逆方向に動きます。これにより重心速度が損なわれ、滑り前の次の足場が視覚的に明らかになることがあります。
接触の革新性、接線力、足の速度、ソールの圧力分布、外部運動を可能な限り監視してください。証拠が適格な定常接触包絡線を離れた場合、接触共分散を膨らませるか、制約を解除する。
観測できないものを理解する
IMUや接触運動学は必ずしもグローバルポジションや絶対ヨーを提供するわけではありません。繰り返し接触することで、外部世界参照を生み出さずに相対運動を制約できます。推定量は、不確実性を観察できない方向に拡大させることを許容すべきであり、ドリフトを隠すのではありません。
タスクにグローバルリファレンスが必要な場合は、ビジョン、ライダー、GNSS、固定マーカーを追加しましょう。遅延または断続的なグローバル測定が、制御を不安定化させる不連続性を生じさせることなくフィルターにどのように入るかを定義します。
チューニング前に時計、フレーム、重力を合わせる
IMU、エンコーダー、フォースセンサー、外部姿勢は異なる速度で動作し、異なる遅延で到達します。衝突付近で数ミリ秒のずれがモデルの故障のように見えることがあります。測定値を取得時間で処理し、有界バッファリングや状態巻き戻しの挙動を保持します。
IMUの名前、ベースフレーム、骨盤フレーム、そして変換方向と利き手を挙げます。重力は防御可能な動き条件下でのみ推定し、ロボットが常に直立していると仮定するのではなく、起動時の向きをテストしてください。
衝撃、振動、飽和の扱い
足の着地は高周波の加速と構造振動を生み出します。フィルタリングはノイズを減らすことができますが、コントローラが最も必要とする位相の推定を遅らせることにもなります。センサーの射程や共鳴の取り付けも、名目上のノイズ密度と同じくらい重要です。
生データとフィルタリング済みデータ、飽和フラグ、フィルター遅延を記録します。通常の歩行、強い着地、かかとやつま先の接触、保護停止を試してください。 脚付き状態推定研究 は学習された接触推定を示していますが、学習された信頼度は依然として分布外と故障の検証を必要とします。
外部の修正は限定され、説明可能にする
ビジョンやライダーは位置停止やヨードリフトを制御できますが、ループ閉鎖の遅延や地図の不一致は大きな状態ジャンプを引き起こすことがあります。ゲート残差は測定年齢を考慮し、コントローラがリセットを受けるか、滑らかな補正を受けるか、または別のグローバルフレームを受け取るかを定義します。
一時的な損失、再局在化、そしてもっともらしい誤相をテストしてください。グローバルセンサーは、単一の監視されていない不連続な運動源になることなく、観測可能性を向上させるべきです。
遷移と下流制御の評価
立ち、シングルサポート、ダブルサポート、タッチダウン、リフトオフ、ターン、ディストラウンス、スリップで指標を分けます。報告の向き、位置誤差と速度誤差、バイアス収束、革新性、共分散一貫性、回復時間。
推定値をヒ ューマノイドバランスコントローラー に接続し、コマンドの結果を記録します。小さな基底速度誤差は、捕獲ステップを変えた場合、大きなグローバル位置誤差よりも大きなダメージを与えることがあります。
| テスト条件 | 推定計量 | 制御指標 | 故障注入 |
|---|---|---|---|
| 立場 | バイアスとドリフト | 姿勢の動き | ウォームスタート |
| ウォーキング | 速度と姿勢の誤差 | 足の位置誤差 | タイミングオフセット |
| 移行 | 革新と飛躍 | トルクまたはCoM過渡現象 | 接触遅延 |
| スリップ | 検出と一貫性 | 回復遅延 | 低摩擦 |
| センサー故障 | 共変性と妥当性 | セーフモードエントリー | フリーズかドロップアウトか |
推定量受理チェックリスト付きリリース
状態定義、フレーム、タイムスタンプポリシー、IMUキャリブレーション、接触モデル、ノイズ、観測可能性、外部補正および劣化挙動を文書化します。各ベンチマークと同期した生データとソフトウェア設定を保存します。
以下のチェックリストで検証を締めくくります。
- 負荷時にIMUとキネマティックフレームをキャリブレーションします。
- 共分散、妥当性、データ年齢を公表します。
- 接触遷移と滑りを明示的にモデル化してください。
- 不確実性は観察できない方向に保持します。
- テスト推定器誤差とバランス制御の結果を合わせて。
よくある質問
ジョイントエンコーダーだけでヒューマノイドの基本ポーズを推定できますか？
正しくモデル化された固定接触に対してのみ相対的です。これらは独立してグローバルなフローティングベースポーズを提供しません。
なぜIMU統合がずれるのか？
角速度と加速度を積分すると、バイアス、ノイズ、重力誤差、スケールやアライメント誤差が蓄積されます。
足の力の閾値は静止した接触を証明しますか？
いいえ。荷重を示しますが、足が揺れたり滑ったりすることもあります。力と運動学的、圧力、運動の証拠を組み合わせましょう。
歩行中は共分散が小さいままでいるべきでしょうか？
測定によって状態が観察可能かつ一貫している場合に限られます。制約が消えたり信頼性を失うと、不確実性は増大すべきです。
最も重要な検証間隔は何でしょうか？
接触仮定が変化し、推定誤差が即座に制御に影響を与えるため、タッチダウン、リフトオフ、スリップが行われます。
信頼接触境界と観測可能状態境界
接触補正は、その静止足の仮定が信頼できる限り安全です。自信のあるドリフトが制御コマンドになる前に、制約を解除または弱めてください。