[論文レビュー] A Primer on the Differential Calculus of 3D Orientations

Michael Bloesch, Hannes Sommer+9 more|arXiv (Cornell University)|Jun 16, 2016

Advanced Numerical Analysis Techniques被引用数 30

ひとこと要約

本稿は、SO(3) 上の指数写像とリー群理論を用いた、3次元回転の表現に依存しない最小限の微分積分法を提示する。ロボット工学および工学分野における最適化のためのロバストで効率的な手法を可能にする。回転の微分および相対回転のための重要な恒等式を導出し、最適化ベースのシステムにおける特異点やパrametrizationに起因するアーティファクトを回避することに焦点を当てる。

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次元回転微分を統一的かつ表現に依存しないフレームワークとして提供すること。
• SO(3) の接空間における最小限で内在的な微分を可能にし、最適化パイプラインにおける数値的安定性と効率性を向上させること。
• Euler角やクォータニオンなどのパrametrization固有のアーティファクトを抽象化することで、異なる実装間の一貫性あるインターフェースを実現すること。

提案手法

• 3次元回転を、クォータニオンや回転行列といった特定のパrametrizationから抽象化した、SO(3) 内の座標変換として定義する。
• リー代数 so(3)（角速度ベクトル）と SO(3) の回転を結ぶ指数写像を用い、滑らかな微分積分を可能にする。
• 行列指数の恒等式 $ \boldsymbol{C}(\boldsymbol{\varphi}) = e^{\boldsymbol{\varphi}^\times} $ を導出し、適用することで、ベクトル表現と回転行列を結びつける。
• 回転更新のための最小限で表現に依存しないヤコビ行列として、接空間微分 $ \boldsymbol{\Gamma}(\boldsymbol{\varphi}) $ を導入する。
• SO(3) 上での随伴作用と合成則を用いた相対回転微分の恒等式を確立し、合成に対して一貫性を保証する。
• 実用的なIMU運動学モデルを通じてフレームワークを検証し、現実世界の最適化タスクにおける有効性を示す。

実験結果

リサーチクエスチョン

• RQ1 パrametrizationに依存せず、次元が最小限であるような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} $ を満たし、座標フレーム変換に対して一貫性があることが確認された。
• このフレームワークにより、最適化における回転チェーンの正しいかつ安定した微分が可能となり、Euler角パrametrizationにありがちな特異点を回避できる。
• 理論的導出はIMU運動学モデルを通じて検証され、状態推定および最適化における実用的応用性が示された。