日本フィジカルAI新聞

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

状態推定arXiv:2604.10057

リー群上の自然勾配ガウス近似フィルタによるロボット状態推定

Natural Gradient Gaussian Approximation Filter on Lie Groups for Robot State Estimation

シェア:XThreadsFacebookLINEはてブBluesky

リー群上で定義された非線形観測モデルを線形化せずに、ガウス分布の増分変数に対する最適化問題として再定式化し、自然勾配法を用いて解く新しいフィルタリング手法を提案した。実機の脚ロボット実験で有効性を実証した。

詳しい要約

1. どんなもの?

Lie群多様体上を進化するロボットシステム(例:脚式ロボット)のための正確な状態推定手法。既存フィルタは接空間での局所線形化に依存し誤差が蓄積する問題があった。本研究は多様体フィルタリングをGaussian-distributed increment variable上のパラメータ最適化問題として再定式化し、線形化を回避する。incrementはexponential operatorを介してLie群に写像され、事前推定に乗算的に作用して事後状態を得る。自然勾配最適化スキームを提案し、increment variableのFisher information matrixを利用して接空間の曲率を考慮する。これによりNatural Gradient Gaussian Approximation on Lie Groups (NANO-L)フィルタを開発。Lie derivativeの摂動モデルを活用し、ロボットローカリゼーションで広く採用されるinvariant observation modelに対して共分散更新が厳密な閉形式解を持つことを証明し、反復更新を不要にして計算効率を向上。U…

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

既存フィルタは非線形観測モデルを接空間での局所線形化で処理するため推定誤差が蓄積する。NANO-Lは線形化を回避し、パラメータ最適化問題として再定式化することでこの限界に対処。さらに自然勾配最適化によりFisher information matrixを用いて接空間の曲率を考慮する点が新しい。invariant observation modelに対して共分散更新の厳密な閉形式解を導出し、反復更新を排除して計算効率を改善。実験では一般的なフィルタより約40%低い推定誤差を同等の計算コストで実現。

3. 技術・手法の肝は?

多様体フィルタリングをGaussian-distributed increment variable上のパラメータ最適化問題として再定式化。incrementはexponential operatorでLie群に写像され、事前推定に乗算的に作用して事後状態を生成。自然勾配最適化スキームを提案し、increment variableのFisher information matrixを利用して接空間の曲率を考慮。Lie derivativeの摂動モデルを活用し、invariant observation modelに対して共分散更新が厳密な閉形式解を持つことを証明。これにより反復更新が不要となり計算効率が向上。

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

Unitree GO2脚式ロボットを用いたハードウェア実験を異なる地形で実施。NANO-Lが一般的に使用されるフィルタと比較して約40%低い推定誤差を同等の計算コストで達成することを示した。

5. 議論はある?

要旨からは不明。

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

要旨で参照/比較されている研究は明示されていない。関連手法として、Lie群上のフィルタリング(例:Invariant Extended Kalman Filter (IEKF)、Multiplicative EKF (MEKF))、自然勾配法、Gaussian approximationフィルタなどが挙げられる。

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

著者: Tianyi Zhang, Wenhan Cao, Chang Liu, Yao Lyu, Shengbo Eben Li

分類: cs.RO

原文アブストラクト

Accurate state estimation for robotic systems evolving on Lie group manifolds, such as legged robots, is a prerequisite for achieving agile control. However, this task is challenged by nonlinear observation models defined on curved manifolds, where existing filters rely on local linearization in the tangent space to handle such nonlinearity, leading to accumulated estimation errors. To address this limitation, we reformulate manifold filtering as a parameter optimization problem over a Gaussian-distributed increment variable, thereby avoiding linearization. Under this formulation, the increment can be mapped to the Lie group through the exponential operator, where it acts multiplicatively on the prior estimate to yield the posterior state. We further propose a natural gradient optimization scheme for solving this problem, whose iteration process leverages the Fisher information matrix of the increment variable to account for the curvature of the tangent space. This results in an iterative algorithm named the Natural Gradient Gaussian Approximation on Lie Groups (NANO-L) filter. Leveraging the perturbation model in Lie derivative, we prove that for the invariant observation model widely adopted in robotic localization tasks, the covariance update in NANO-L admits an exact closed-form solution, eliminating the need for iterative updates thus improving computational efficiency. Hardware experiments on a Unitree GO2 legged robot operating across different terrains demonstrate that NANO-L achieves approximately 40% lower estimation error than commonly used filters at a comparable computational cost.

関連論文

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

PR・アフィリエイト広告

FRONTIER(GPU搭載BTOパソコン)

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