[논문 리뷰] Pose Graph Optimization in the Complex Domain: Lagrangian Duality, Conditions For Zero Duality Gap, and Optimal Solutions

Giuseppe C. Calafiore, Luca Carlone외 1명|arXiv (Cornell University)|2015. 05. 13.

Robotics and Sensor-Based Localization참고 문헌 73인용 수 5

한 줄 요약

이 논문은 복소수 도메인에서 라그랑주 이중성의 성질을 활용하여 포즈 그래프 최적화(Pose Graph Optimization, PGO)를 해결하는 새로운 접근법을 제안한다. 이는 포즈 그래프에 제약을 가한 매트릭스가 정확히 하나의 영고유값을 가질 때, 제로 이중성 갭(즉, 전역 최적성 보장 가능)을 달성함을 증명한다. 이 방법은 준선형계획법(-semidefinite programming, SDP)과 고유벡터 스케일링을 통해 전역 최적해를 계산하며, 실제 로봇 주행 환경의 노이즈 조건에서 이 조건이 100%로 성립함을 실험적으로 입증하였다.

ABSTRACT

Pose Graph Optimization (PGO) is the problem of estimating a set of poses from pairwise relative measurements. PGO is a nonconvex problem, and currently no known technique can guarantee the computation of an optimal solution. In this paper, we show that Lagrangian duality allows computing a globally optimal solution, under certain conditions that are satisfied in many practical cases. Our first contribution is to frame the PGO problem in the complex domain. This makes analysis easier and allows drawing connections with the recent literature on unit gain graphs. Exploiting this connection we prove non-trival results about the spectrum of the matrix underlying the problem. The second contribution is to formulate and analyze the dual problem in the complex domain. Our analysis shows that the duality gap is connected to the number of eigenvalues of the penalized pose graph matrix, which arises from the solution of the dual. We prove that if this matrix has a single eigenvalue in zero, then (i) the duality gap is zero, (ii) the primal PGO problem has a unique solution, and (iii) the primal solution can be computed by scaling an eigenvector of the penalized pose graph matrix. The third contribution is algorithmic: we exploit the dual problem and propose an algorithm that computes a guaranteed optimal solution for PGO when the penalized pose graph matrix satisfies the Single Zero Eigenvalue Property (SZEP). We also propose a variant that deals with the case in which the SZEP is not satisfied. The fourth contribution is a numerical analysis. Empirical evidence shows that in the vast majority of cases (100% of the tests under noise regimes of practical robotics applications) the penalized pose graph matrix does satisfy the SZEP, hence our approach allows computing the global optimal solution. Finally, we report simple counterexamples in which the duality gap is nonzero, and discuss open problems.

연구 동기 및 목표

• 비볼록 포즈 그래프 최적화(PGO) 문제에서 전역 최적해를 계산하는 데 오랫동안 해결되지 않은 과제를 해결하고자 하며, 현재의 반복적 방법들이 전역 최적성을 보장하지 못한다는 점을 다루고자 한다.
• PGO 문제에서 이중성 갭이 제로가 되는 이론적 조건을 설정하여 전역 최적성의 인증 가능성을 확보하고자 한다.
• 단일 영고유값 성질(Single Zero Eigenvalue Property, SZEP)이 성립할 경우 전역 최적해를 계산할 수 있는 알고리즘 프레임워크를 개발하고자 한다.
• 제약을 가한 포즈 그래프 매트릭스의 스펙트럼 성질을 분석하고, 이와 이중성 갭 및 해의 유일성 간의 관계를 규명하고자 한다.
• 실제 로봇 주행 환경에서의 노이즈 시나리오에 걸쳐 실험적으로 방법을 검증하여, SZEP 조건이 거의 전역적으로 적용 가능함을 보여주고자 한다.

제안 방법

• PGO 문제를 복소수 도메인에서 재정의하여 분석을 단순화하고, 단위 이득 그래프와의 연결 고리를 활용하고자 한다.
• 라그랑주 이중 문제를 준선형계획법(Semidefinite Program, SDP)으로 도출하여, 비볼록 PGO 문제의 볼록화된 근사화를 가능하게 한다.
• 제약을 가한 포즈 그래프 매트릭스가 정확히 하나의 영고유값을 가질 때에만 이중성 갭이 제로임을 증명한다(SZEP 조건).
• 제약을 가한 매트릭스의 영고유값에 대응하는 고유벡터를 스케일링하여 원래 문제의 최적해를 구성한다.
• 이중 단계 알고리즘을 제안한다: 첫 번째 단계에서 SDP 이중 문제를 풀고, 두 번째 단계에서 SZEP 조건이 성립할 경우 고유벡터 스케일링을 통해 원래 해를 복원한다.
• SZEP 조건이 성립하지 않는 경우를 대비한 변형 알고리즘을 제안하며, 실질적으로 고급 품질의 부분최적해를 제공한다.

실험 결과

연구 질문

• RQ1 라그랑주 이중 문제의 PGO에서 이중성 갭이 제로가 되는 조건은 무엇인가?
• RQ2 제약을 가한 포즈 그래프 매트릭스의 스펙트럼 성질은 전역 최적해의 존재성과 유일성과 어떻게 관련이 있는가?
• RQ3 원래 최적해는 이중 해로부터 고유벡터 스케일링을 통해 직접 복원할 수 있는가?
• RQ4 실제 로봇 응용에서 현실적인 노이즈 조건 하에서 단일 영고유값 성질(SZEP)이 얼마나 자주 성립하는가?
• RQ5 기본 반복적 해법과 비교했을 때, 제안된 방법의 최적성 및 수렴 성능은 어떠한가?

주요 결과

• 이중성 갭이 제로임은 제약을 가한 포즈 그래프 매트릭스가 정확히 하나의 영고유값을 가질 때에만 성립하며, 이는 전역 최적성과 해의 유일성 보장을 동시에 보장한다.
• SZEP 조건이 성립할 경우, 제약을 가한 매트릭스의 영고유값에 대응하는 고유벡터를 스케일링하여 원래 최적해를 정확히 계산할 수 있다.
• 실제 로봇 주행 환경의 노이즈 수준에서 테스트한 모든 케이스에서 제약을 가한 포즈 그래프 매트릭스가 SZEP 조건을 만족하여, 모든 테스트 케이스에서 전역 최적성이 달성됨을 확인하였다.
• 제안된 알고리즘은 준선형계획법과 고유벡터 추출을 통해 다항식 시간 내에 전역 최적해를 계산한다.
• SZEP 조건이 성립하지 않는 경우에도 제안된 변형 알고리즘이 실질적으로 높은 품질의 근사해를 제공하며, 실용적 성능이 뛰어나다.
• 반례를 통해 비영고유값이 존재할 경우 이중성 갭이 비제로가 될 수 있음을 입증하여, 전역 최적성 보장을 위해 SZEP 조건이 반드시 필요함을 강조한다.