[논문 리뷰] A tutorial on SE(3) transformation parameterizations and on-manifold optimization

Jose‐Luis Blanco|arXiv (Cornell University)|2012. 01. 01.

Robotics and Sensor-Based Localization참고 문헌 16인용 수 178

한 줄 요약

이 논문은 오일러 각도, 회전 행렬, 그리고 허니터니언을 사용한 SE(3) 변환의 표현 및 최적화에 대한 통합 가이드를 제시한다. 각 표현 간의 상호 변환, 자세 조합, 그리고 불확실성 전파를 상세히 다루며, MRPT 라이브러리에 구현된 검증된 자코비안과 실용적인 C++ 구현을 통해 로봇공학 및 컴퓨터 비전 분야에서 다층적 최적화를 가능하게 한다.

ABSTRACT

An arbitrary rigid transformation in SE(3) can be separated into two parts, namely, a translation and a rigid rotation. This technical report reviews, under a unifying viewpoint, three common alternatives to representing the rotation part: sets of three (yaw-pitch-roll) Euler angles, orthogonal rotation matrices from SO(3) and quaternions. It will be described: (i) the equivalence between these representations
 and the formulas for transforming one to each other (in all cases considering the translational and rotational parts as a whole), (ii) how to compose poses with poses and poses with points in each representation and (iii) how the uncertainty of the poses (when modeled as Gaussian distributions) is affected by these transformations and compositions. Some brief notes are also given about the
 Jacobians required to implement least-squares optimization on manifolds, an very promising approach in recent engineering literature. The text reflects which MRPT C++ library functions implement each of the described algorithms. All the implementations have been thoroughly validated by means of unit testing and numerical estimation of the Jacobians.

연구 동기 및 목표

• 오일러 각도, 회전 행렬(SO(3)), 그리고 허니터니언이라는 세 가지 일반적인 자세 매개변수화를 사용하여 SE(3) 변환의 표현을 통합하고 명확히 하는 것.
• 이 표현 간의 변환을 체계적으로 유도하고 전체 자세(이동 + 회전)의 구조를 유지하는 것.
• 필요한 수학적 도구와 자코비안을 제공함으로써 로봇공학 및 컴퓨터 비전에서 정확하고 효율적인 다층적 최적화를 가능하게 하는 것.
• 단위 테스트와 수치적 추정을 통해 모든 변환과 자코비안의 정확성을 검증하는 것.
• 이론적 프레임워크를 MRPT C++ 라이브러리 내 해당 기능에 매핑하여 즉각적인 실용적 활용을 가능하게 하는 것.

제안 방법

• 오일러 각도, 회전 행렬(SO(3)), 그리고 허니터니언 간의 명시적 변환 공식을 유도하여 전체 SE(3) 자세 공간에서 일관성을 확보하는 것.
• 각 표현을 사용하여 두 개의 SE(3) 자세를 조합하고 3차원 점에 자세를 적용하는 방법을 기술하여 기하학적 정확성을 유지하는 것.
• SE(3) 변환과 조합에서 가우시안 불확실성의 전파를 분석하고, 각 매개변수화에서 공분산 행렬이 어떻게 변하는지 보여주는 것.
• 상태 추정 및 번들 조정에 필수적인 다층적 최소 제곱 최적화를 위한 자코비안을 유도하는 것.
• 모든 알고리즘을 MRPT C++ 라이브러리에 통합하고, 포괄적인 단위 테스트와 수치적 자코비안 검증을 통해 검증하는 것.
• 로봇 소프트웨어 스택에서 이론적 분석과 실용적 구현을 모두 지원하는 일관된 수학적 프레임워크를 제시하는 것.

실험 결과

연구 질문

• RQ1 오일러 각도, 회전 행렬, 허니터니언이라는 세 가지 주요 자세 표현 방식은 전체 SE(3) 자세의 맥락에서 어떻게 상호 연관되어 있는가?
• RQ2 각 표현을 사용하여 SE(3) 자세를 조합하고 3차원 점을 변환하는 데 적합하고 효율적인 공식은 무엇인가?
• RQ3 자세의 불확실성(공분산)은 다른 자세와 조합되거나 점에 적용될 때 어떻게 변하는가?
• RQ4 SE(3)에서 다층적 최적화를 위해 필요한 분석적 자코비안은 무엇이며, 어떻게 신뢰성 있게 계산하고 검증할 수 있는가?
• RQ5 이론적 프레임워크는 어떻게 실용적이고 생산용 C++ 코드로 MRPT 라이브러리에 매핑될 수 있는가?

주요 결과

• 논문은 오일러 각도, 회전 행렬, 허니터니언 간의 완전하고 일관된 변환 프레임워크를 구축하여 전체 SE(3) 자세의 구조를 유지한다.
• 모든 세 표현 간의 SE(3) 자세 조합 및 3차원 점 변환을 위한 명시적이고 검증된 공식을 제공한다.
• 자세 조합 과정에서 공분산 행렬의 전파를 자코비안 기반 변환을 통해 정확하게 모델링한다.
• 다층적 최적화를 위한 유도된 자코비안은 수치적 추정과 단위 테스트를 통해 검증되어 비선형 최적화 파이프라인에서 신뢰성 있게 사용될 수 있다.
• 모든 수학적 수식은 MRPT C++ 라이브러리에 구현되어 있으며, 전체 테스트 커버리지가 제공되어 있어 로봇공학 및 비전 응용 분야에서 즉각적으로 활용할 수 있다.
• SE(3) 표현의 통합적 접근은 상태 추정 및 SLAM 시스템에서 강력하고 효율적이며 수치적으로 안정된 최적화를 가능하게 한다.