[論文レビュー] Rigid Body Localization via Gaussian Belief Propagation with Quadratic Angle Approximation

Niclas Führling, Hyeon Seok Rou+3 more|arXiv (Cornell University)|Feb 4, 2026

Robotics and Sensor-Based Localization被引用数 0

ひとこと要約

論文は新規の二次角近似を用いるGaussian Belief Propagation (GaBP) アプローチを提案し、小角近似なしで正確な回転と平行移動推定を可能にしつつ、計算量を低く保つ。

ABSTRACT

Gaussian belief propagation (GaBP) is a technique that relies on linearized error and input-output models to yield low-complexity solutions to complex estimation problems, which has been recently shown to be effective in the design of range-based GaBP schemes for stationary and moving rigid body localization (RBL) in three-dimensional (3D) space, as long as an accurate prior on the orientation of the target rigid body is available. In this article we present a novel range-based RBL scheme via GaBP that removes the latter limitation. To this end, the proposed method incorporates a quadratic angle approximation to linearize the relative orientation between the prior and the target rigid body, enabling high precision estimates of corresponding rotation angles even for large deviations. Leveraging the resulting linearized model, we derive the corresponding message-passing (MP) rules to obtain estimates of the translation vector and rotation matrix of the target rigid body, relative to a prior reference frame. Numerical results corroborate the good performance of the proposed angle approximation itself, as well as the consequent RBL performance in terms of root mean square errors (RMSEs) in comparison to the state-of-the-art (SotA), while maintaining a low computational complexity

研究の動機と目的

• 正確な初期姿勢を必要とせず、距離ベースの剛体定位（RBL）を動機付ける。
• 大角偏差に対して回転を線形化する二次角近似を導入する。
• GaBP ベースの翻訳と回転の同時推定を可能にする線形化されたシステムモデルを導出する。
• 翻訳干渉除去戦略を含む双線形 GaBP アルゴリズムを開発し、RBL パラメータをロバストに推定する。
• RMSE と計算効率の点で最先端法と性能を比較評価する。

提案手法

• 回転行列を線形化可能とするための回転の二次角近似を提案し、より大きな角範囲での線形化を可能にする。
• 事前角度依存パラメータ付け（α, β, γ, δ, L, D, Θ）を用いて回転を仮想的なアファイン線形形にベクトル化する。
• 更新された Hθ および Ht 行列を介して、回転 θ と並進 t による距離測定を関係づける線形化された測定モデルを導出する。
• 回転と翻訳を同時推定するためのソフト干渉除去を備えた双線形 GaBP アルゴリズムを開発し、推定 t を翻訳した後に回転を追加で精密化するための改良パスを含める。
• アルゴリズム1（RBL パラメータ推定のための二重 GaBP）を提供し、反復的 GaBP ステップと回転・翻訳の二重ループ改良を概説する。

実験結果

リサーチクエスチョン

• RQ1 GaBP は小角近似に依存せず、距離ベース設定で回転と翻訳を同時に推定できるか。
• RQ2 二次角近似は大きな姿勢変更に対する回転推定の精度を、従来の小角アプローチと比較して改善するか。
• RQ3 提案手法を用いた GaBP ベースの RBL は、最先端手法と比較して RMSE と計算複雑度の点でどのようにのパフォーマンスを示すか。
• RQ4 干渉除去ステップは GaBP 内の回転パラメータ推定の精度にどのような影響を与えるか。

主な発見

• 二次角近似は従来の小角近似と比較して回転モデル誤差を大幅に低減し、特に角度が約20–45度程度までの範囲で有効である。
• 線形化されたモデルは回転と翻訳の GaBP 推定を可能とし、競争力のある精度と低い計算複雑度を実現する。
• 干渉除去を組み込んだ二重 GaBP 手法は翻訳影響を分離することで回転推定を改善する。
• 数値結果は、小角近似に依存する最先端の GaBP ベース RBL アプローチと比較して提案手法の良好な性能を裏付ける。
• このアプローチはリアルタイムあるいは資源制約下のシナリオに適した、良好な精度-計算量のトレードオフを維持する。