アーカイブ / Robotics
足のIMUと接地時の速度補正で二足歩行の軌跡を推定する
Pedestrian Dead Reckoning using Invariant Extended Kalman Filter
Pedestrian Dead Reckoning using Invariant Extended Kalman Filterの原論文から掲載した図です。細部はクリックして拡大できます。
原論文の図の説明を読む
Fig. 1: The pedestrian walking consists of walk phase and stance phase, which correspond to the prediction step and innovation update step in InEKF.
概要
- 足のIMUで姿勢・速度・位置を予測し、接地中の「速度ゼロ」を使って補正する。
- 著者らは三種類の実験で標準EKFと比較し、InEKFの良好な推定と調整のしやすさを報告する。
- 確認できた本文に誤差指標と結果の数値はなく、導入前には基準軌跡との照合が必要である。
補足：編集した模式図で仕組みを確認する
VISUAL EXPLAINER
図でつかむ、Pedestrian Dead Reckoning using Invariant Extended Kalman Filterの仕組み
- 01足のIMU計測
- 02姿勢・速度・位置の予測
- 03接地中の速度補正
- 04推定軌跡と姿勢
原論文の説明をもとにした模式図です。処理の細部は省略しています。
研究の背景
この方法は、足に付けた慣性計測装置（IMU）の角速度と加速度から、歩行中の位置と向きを推定する。屋内など衛星測位を利用しにくい場所では、ロボット自身の計測から移動経路を求める必要がある。
ただし、IMUの値を積み重ねて位置を計算すると、計測誤差も蓄積する。歩行中に足が地面に着いて静止する時間を補正に使い、位置ずれを抑えることが、この研究の課題である。
手法
足のIMUから得る角速度と加速度を使い、次の時刻の姿勢、速度、位置を予測する。回転と速度・位置を一つの行列で表す数学的な枠組みが「行列リー群」であり、その上で推定誤差を扱う手法が不変拡張カルマンフィルター（InEKF）である。計測値が一定方向にずれる「バイアス」も推定する。
例えば一歩進む間はIMUの値から移動を計算する。一定時間分の計測を見て、しきい値により足が静止したと判定すると、「速度はゼロ」という擬似計測値で予測を補正する。擬似計測値とは別のセンサーによる実測ではなく、接地状態から置く条件を指す。補正した状態を次の予測につなぐ。
新規性
著者らの提案は、足に装着したIMUの計測と接地中の「速度ゼロ」を、不変拡張カルマンフィルター（InEKF）で組み合わせる方法である。専用の接触センサーを使わず、角速度と加速度の計測値の偏りも推定対象に含める。
姿勢・速度・位置を行列リー群で扱う理論と、離散時間での予測・補正手順を示している。調整のしやすさも著者らの主張だが、確認できた本文の範囲では感度分析の数値は示されていない。
従来手法との違い
比較対象は標準的な拡張カルマンフィルター（EKF）である。EKFは推定中の状態の周りで計算を近似する。InEKFは回転を含む状態を行列リー群として表し、姿勢・速度・位置の推定誤差を使って予測と補正を行う。
著者らは三種類の実験で両者を比較し、InEKFの方が良好で調整しやすいと述べる。二足歩行ロボットの実験ではEKFが機能せず、InEKFは安定して推定したと報告するが、確認できた本文には比較条件や誤差値がない。
実験結果
著者らは、動作計測を基準にした実験、大規模な多層階歩行実験、二足歩行ロボット実験でInEKFと標準EKFを比較したと述べる。IMUにはMPU6050を使い、角速度と加速度を100 Hzで取得した。調整に関する感度分析も行ったという。
著者らはInEKFがEKFより良好で、ロボット実験でも安定して状態を推定したと報告する。確認できた本文の範囲では、軌跡誤差の指標や数値、実験ごとの条件、感度分析の結果表がなく、改善幅は評価できない。
応用の可能性
編集上の応用案 · 論文が実証した用途とは区別しています。
編集上の応用案：屋内を歩く二足歩行ロボットの移動履歴を記録する。足に装着したIMUの角速度と加速度を入力し、接地して静止したと判定した時点で速度の推定を補正する。出力する時刻ごとの位置と姿勢を、運用画面の軌跡表示に使う。
この構成に学習用データや学習ラベルは前提としない。導入先では、接地判定を合わせるために静止区間のラベル付き計測と、軌跡を照合する基準位置の記録を用意する。足が滑る区間も記録し、適用できる歩行条件を確かめる。
応用先の候補からNauhに相談できます。
導入時の検証
導入時の検証案 · 対象データでの再評価が必要です。
導入時の検証案：対象ロボットの足に付けたIMUから角速度と加速度を集め、足が静止した区間のラベルと、照合用の基準軌跡を記録する。同じ計測列に標準EKFとInEKFを適用し、接地判定のしきい値と雑音設定を記録する。
歩行ごとの位置ずれを基準軌跡と照合し、接地ラベルに対する判定の一致率と、推定が途切れた区間も調べる。床材と歩行速度を変えて差を確認する。学習用データは要しない構成だが、接地判定やIMUの偏りの設定を現場に合わせる必要があるかを検証する。
限界と課題
著者らは、外部の位置計測がないためInEKFでも速度・位置の誤差蓄積は避けられないと記す。接地中の速度ゼロは足が滑らないことを前提とし、滑りの影響は計測雑音として扱う。IMUの角速度と加速度に生じる偏りも推定対象に含めている。
編集上の検証事項は、床材や歩き方が変わったときの接地判定、滑りが続く場合の位置ずれ、初期姿勢や雑音設定への感度である。確認できた本文の範囲では、実験条件と誤差表の全容を確認できず、適用範囲を数値で判断できない。
出典
元のタイトル・要旨を確認する（英語）
Pedestrian Dead Reckoning using Invariant Extended Kalman Filter
This paper presents a cost-effective inertial pedestrian dead reckoning method for the bipedal robot in the GPS-denied environment. Each time when the inertial measurement unit (IMU) is on the stance foot, a stationary pseudo-measurement can be executed to provide innovation to the IMU measurement based prediction. The matrix Lie group based theoretical development of the adopted invariant extended Kalman filter (InEKF) is set forth for tutorial purpose. Three experiments are conducted to compare between InEKF and standard EKF, including motion capture benchmark experiment, large-scale multi-floor walking experiment, and bipedal robot experiment, as an effort to show our method's feasibility in real-world robot system. In addition, a sensitivity analysis is included to show that InEKF is much easier to tune than EKF.
論文本体の取得範囲に基づく解説。AIが作成した未校閲の記事です。性能の数値は著者の評価条件に依存します。応用例と検証計画は編集上の提案です。解説更新：2026-10-01