日本フィジカルAI新聞

世界のフィジカルAIを、日本語で。

姿勢推定/フィルタリングarXiv:2606.25083

多IMU関節剛体システムにおける拡張姿勢推定のための不変カルマンフィルタリング

Invariant Kalman filtering for extended pose estimation in multi-IMU articulated rigid-body systems

シェア:XThreadsFacebookLINEはてブBluesky

関節剛体システムの各リンクにIMUを取り付け、相対姿勢をLie群表現で扱うことで不変フィルタの理論を拡張し、関節拘束を不変形式で組み込んだ反復不変拡張カルマンフィルタを提案。UR5eロボットと人間の脚で検証し、既存手法より誤差を50%以上削減した。

詳しい要約

1. どんなもの?

IMUを各bodyに装着したarticulated rigid-body systems(関節を持つ剛体システム)のextended pose(姿勢・速度・位置)を推定する問題に対し、relative L-extended poseというLie group表現と、joint constraintsをnoise-free pseudo-measurementsとして組み込んだiterated IEKF(IterIEKF)を提案する研究。kinematic treeに沿ってrelative blocksを連結し各bodyのabsolute poseを復元する。

2. 先行研究と比べてどこがすごい?

従来のIEKFは単一剛体に対して収束保証とunobservability下でのconsistencyを持つが、articulated systemsへの拡張はinter-body pose couplingのため自明でなく、joint kinematic constraintsをinvariant frameworkに組み込むことは未解決だった。提案法はこのギャップを埋め、EKF・IterEKF・absolute-pose IterIEKFの全baselineを上回る。

3. 技術・手法の肝は?

relative L-extended poseというkinematic-tree systems向けのLie group表現を導入。bodyごとに1つのIMUを仮定し、group-affine dynamicsを得る。joint constraintsをinvariant formで表現し、noise-free pseudo-measurementsとしてIterIEKFに組み込むことで、invariant filteringの収束・consistency保証を保持する。absolute poseはkinematic treeに沿ってrelative blocksを連結して復元する。

4. どうやって有効だと検証した?

UR5e robotとhuman legの2つのシナリオで検証。提案IterIEKFはEKF・IterEKF・absolute-pose IterIEKFの全baselineを上回り、より速く収束し、run-to-run variabilityが低く、全シナリオで最低RMSEを達成。2番目に良いfilterと比べ少なくとも50%のRMSE削減。

5. 議論はある?

要旨からは不明。

6. 次に読むべき論文は?

要旨で参照・比較されているEKF、IterEKF、absolute-pose IterIEKF、および基盤となるinvariant extended Kalman filter(IEKF)の関連研究。articulated systemsやkinematic-tree、Lie groupに基づくstate estimationの定番文献も候補。

※ AIが要旨から生成した要約です。正確性は原文をご確認ください。

著者: Sven Goffin, Cédric Schwartz, Silvère Bonnabel, Olivier Brüls, Pierre Sacré

分類: cs.RO

原文アブストラクト

Accurate extended pose estimation (orientation, velocity, and position) for IMU-instrumented articulated rigid-body systems is a key challenge in robotics and human motion analysis. The invariant extended Kalman filter (IEKF) addresses this problem for a single rigid body with convergence guarantees and consistency under unobservability, but extending these properties to articulated systems is nontrivial: inter-body pose coupling prevents a direct application, and incorporating joint kinematic constraints within the invariant framework remains an open problem. To address this gap, we introduce the relative L-extended pose, a Lie group representation for kinematic-tree systems based on relative poses between bodies. With one IMU per body, it yields group-affine dynamics and allows joint constraints to be expressed in invariant form. We incorporate these constraints as noise-free pseudo-measurements within an iterated IEKF (IterIEKF), thereby preserving the convergence and consistency guarantees of invariant filtering. The absolute pose of each body is then recovered by chaining the relative blocks along the kinematic tree. Validated on both a UR5e robot and a human leg, the proposed IterIEKF outperforms all EKF, IterEKF, and absolute-pose IterIEKF baselines. It converges faster, exhibits lower run-to-run variability, and consistently achieves the lowest RMSE, with reductions of at least 50% compared to the second-best filter across all scenarios considered in this work.

  1. 1Boston Dynamics、車輪付きAtlasの研究試作機を紹介研究・技術
  2. 2newmoとKDDIが資本業務提携 2028年に堺市で自動運転タクシー商用化目指す提携・買収
  3. 3NVIDIA、CoRLでGR00T 2とIsaac Lab 3.0を発表新製品・発表
  4. 4GXOとApptronik、Apolloの物流現場試験を拡大 最大1,000台の展開を構想量産・展開
  5. 5UC BerkeleyとNVIDIAの研究者、AIエージェントでロボット制御コードを仮想環境で改善研究・技術

PR・アフィリエイト広告

FRONTIER(GPU搭載BTOパソコン)

FRONTIER(GPU搭載BTOパソコン)の公式広告バナーFRONTIERでGPU搭載PCを見る ↗
PR本紙発行元 EmplifAI