[논문 리뷰] A Primer on the Differential Calculus of 3D Orientations

Michael Bloesch, Hannes Sommer외 9명|arXiv (Cornell University)|2016. 06. 16.

Advanced Numerical Analysis Techniques인용 수 30

한 줄 요약

이 논문은 3차원 자세의 표현에 관계없이 최소한의 미분법을 제안하며, SO(3)에서의 지수사상과 리군 이론을 활용하여 로봇공학 및 공학 분야에서 강력하고 효율적인 최적화를 가능하게 한다. 자세의 도함수 및 상대 자세에 대한 핵심 항등식을 유도하며, 최적화 기반 시스템에서의 특이점과 표현에 기반한 오류를 피하는 데 중점을 둔다.

ABSTRACT

The proper handling of 3D orientations is a central element in many optimization problems in engineering. Unfortunately many researchers and engineers struggle with the formulation of such problems and often fall back to suboptimal solutions. The existence of many different conventions further complicates this issue, especially when interfacing multiple differing implementations. This document discusses an alternative approach which makes use of a more abstract notion of 3D orientations. The relative orientation between two coordinate systems is primarily identified by the coordinate mapping it induces. This is combined with the standard exponential map in order to introduce representation-independent and minimal differentials, which are very convenient in optimization based methods.

연구 동기 및 목표

• 3차원 자세를 포함한 최적화 문제를 설정할 때 엔지니어와 연구자들이 겪는 일반적인 어려움, 즉 일관되지 않은 관례와 비최적의 표현 방식을 해결하기 위해.
• 특수직교군 SO(3)와 지수사상을 활용하여 3차원 자세 미분을 다루는 통합적이고 표현에 관계없는 프레임워크를 제공하기 위해.
• 최적화 파ip라인에서 수치적 안정성과 효율성을 향상시키기 위해 SO(3)의 탄성공간에서 최소한이고 내재된 도함수를 가능하게 하기 위해.
• 예를 들어 올리어 각도, 허니톤 등 표현 방식에 의존하는 특이성들을 추상화함으로써, 다양한 구현 간의 일관된 상호작용을 촉진하기 위해.

제안 방법

• 3차원 자세를 허니톤 또는 로테이션 행렬과 같은 특정 표현 방식에서 독립적으로 SO(3) 내의 좌표 매핑 변환으로 정의하기.
• 리 대수 so(3)의 원소인 각속도 벡터(3차원 벡터)와 SO(3)의 로테이션을 연결하기 위해 지수사상을 사용하여 부드러운 미분법을 가능하게 하기.
• 행렬 지수 항등식 $ \boldsymbol{C}(\boldsymbol{\varphi}) = e^{\boldsymbol{\varphi}^\times} $ 를 유도하고 적용하여, 벡터 표현과 로테이션 행렬을 연결하기.
• 자세 업데이트를 위한 최소한이고 표현에 관계없는 야코비안으로서 탄성공간 도함수 $ \boldsymbol{\Gamma}(\boldsymbol{\varphi}) $ 를 도입하기.
• SO(3)에서의 상대 자세 도함수에 대한 항등식을 애드조인 작용과 연쇄법칙을 사용하여 유도하여, 복합 연산에 있어서도 일관성을 확보하기.
• 실제 IMU 운동학 모델을 통한 검증을 통해, 이 프레임워크가 실제 최적화 작업에서의 유용성을 입증하기.

실험 결과

연구 질문

• RQ1 표현 방식에 의존하지 않으며 차원이 최소화된 방식으로 3차원 자세 도함수를 어떻게 구성할 수 있는가?
• RQ2 SO(3)에서 자세 복합의 도함수를 계산하기 위한 올바른 수학적 항등식은 무엇인가?
• RQ3 지수사상을 어떻게 활용하여 로봇공학 분야의 최적화에서 일관되고 수치적으로 안정된 도함수를 도출할 수 있는가?
• RQ4 리이론적 프레임워크 내에서 애드조인 표현은 좌표 프레임 간의 각속도를 변환하는 데 어떤 역할을 하는가?
• RQ5 제안된 수학적 체계는 운동학적 시스템 내에서 IMU의 역학을 모델링하고 최적화하는 데 어떻게 적용될 수 있는가?

주요 결과

• 논문은 항등식 $ \boldsymbol{C}(\boldsymbol{\varphi}) = e^{\boldsymbol{\varphi}^\times} $ 를 유도하여, 임의의 로테이션 행렬이 3차원 벡터에서 유도된 반대칭행렬의 지수를 통해 생성될 수 있음을 보여준다.
• 로테이션 행렬의 자세 벡터에 대한 도함수는 $ \boldsymbol{\Gamma}(\boldsymbol{\varphi}) = \frac{(\boldsymbol{I} - \boldsymbol{C}(\boldsymbol{\varphi}))\boldsymbol{\varphi}^\times + \boldsymbol{\varphi}\boldsymbol{\varphi}^T}{\|\boldsymbol{\varphi}\|^2} $ 로 주어지며, 이는 최소화되고 표현에 관계없는 것으로 확인된다.
• 애드조인 작용은 $ \exp(\Phi(\boldsymbol{\varphi})) = \Phi \circ \exp(\boldsymbol{\varphi}) \circ \Phi^{-1} $ 를 만족하여, 좌표 프레임 변환에 있어서도 일관성을 입증한다.
• 이 프레임워크는 올리어 각도 표현에서 흔히 발생하는 특이점을 피하면서 최적화에서 자세 체인의 정확하고 안정적인 미분을 가능하게 한다.
• 이론적 유도 결과는 IMU 운동학 모델을 통한 검증을 통해 실제 상태 추정 및 최적화 작업에서의 적용 가능성을 입증한다.