[논문 리뷰] Rigid Body Localization via Gaussian Belief Propagation with Quadratic Angle Approximation

Niclas Führling, Hyeon Seok Rou외 3명|arXiv (Cornell University)|2026. 02. 04.

Robotics and Sensor-Based Localization인용 수 0

한 줄 요약

본 논문은 새로운 2차 각도 근사를 사용하는 가우시안 신념 전파(GaBP) 기반의 강체 위치 추정(RBL) 방법을 제시하여, 작은 각도 사전 정보 없이도 정확한 회전 및 병진 추정을 가능하게 하면서 계산 복잡도는 낮게 유지한다.

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)을 적용할 수 있도록 동기를 부여한다.
• 큰 각도 편차에 대해 회전을 선형화하기 위한 2차 각도 근사를 도입한다.
• 병진과 회전의 GaBP 기반 공동 추정을 가능하게 하는 선형화된 시스템 모델을 도출한다.
• 강체 위치 추정 매개변수를 견고하게 추정하기 위한 이차쌍 GaBP 알고리즘과 간섭 제거 전략을 개발한다.
• 상태-오브-더-아트 방법과 비교하여 RMSE 및 계산 효율성 측면에서 성능을 평가한다.

제안 방법

• 큰 각도 범위에서 선형화를 가능하게 하기 위한 회전 행렬의 2차 각도 근사를 제안한다.
• 사전 각도 의존 파라미터화(α, β, γ, δ, L, D, Θ)를 사용하여 회전을 아핀 선형 형태로 벡터화한다.
• 갱신된 Hθ 및 Ht 행렬을 통해 거리 측정과 강체 매개변수(회전 θ 및 병진 t)를 연결하는 선형화된 측정 모델을 도출한다.
• 소프트 간섭 제거를 포함한 쌍선형 GaBP 알고리즘을 개발하여 회전과 병진을 공동으로 추정하고, 추정된 t를 제거한 후 회전에 대한 추가 정합 단계를 포함한다.
• 알고리즘 1(강체 위치 추정 매개변수 추정을 위한 이중 GaBP)을 제공하여 반복적 GaBP 단계와 회전 및 병진에 대한 두 루프 정합을 제시한다.

실험 결과

연구 질문

• RQ1 자가 적합한 작은 각도 근사 없이도 GaBP가 거리 기반 설정에서 강체의 병진과 회전을 공동으로 추정할 수 있는가?
• RQ2 2차 각도 근사가 전통적인 작은 각도 접근에 비해 큰 방향 전환에 대해 회전 추정 정확도를 개선하는가?
• RQ3 제안된 GaBP 기반 RBL이 RMSE 및 계산 복잡도 측면에서 상태-아트 방법과 비교하여 어떤 성능을 보이는가?
• RQ4 간섭 제거 단계가 GaBP 내 회전 매개변수 추정의 정확도에 미치는 영향은 얼마인가?

주요 결과

• 2차 각도 근사는 기존의 작은 각도 근사에 비해 회전 모델 오차를 크게 줄이며, 특히 각이 약 20–45도까지의 경우에 효과적이다.
• 선형화된 모델은 회전과 병진의 GaBP 기반 추정을 가능하게 하며, 경쟁력 있는 정확도와 낮은 계산 복잡도를 제공한다.
• 간섭 제거를 동반한 이중 GaBP 절차는 병진 효과를 분리하여 회전 추정을 향상시킨다.
• Numerical results corroborate the proposed method’s good performance relative to state-of-the-art GaBP-based RBL approaches that rely on small-angle approximations.
• 본 접근법은 실시간 또는 자원 제약 상황에 적합한 우수한 정확도-복잡도 트레이드오프를 유지한다.