[論文レビュー] A tutorial on SE(3) transformation parameterizations and on-manifold optimization

Jose‐Luis Blanco|arXiv (Cornell University)|Jan 1, 2012

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)）、クォータニオンの3つの代表的な回転パラメータ化を用いたSE(3)変換の表現を統合的かつ明確に提示すること。
• これらの表現間の変換を体系的に導出し、ポーズ全体（並進＋回転）の構造を保持すること。
• 必要な数学的ツールとヤコビ行列を提供することで、ロボット工学およびコンピュータビジョンにおける正確で効率的なマニフォールド上最適化を可能にすること。
• ユニットテストと数値推定を用いて、すべての変換とヤコビ行列の正しさを検証すること。
• 理論的フレームワークをMRPT C++ライブラリ内の対応関数にマッピングし、直ちに実用に応用可能な形にすること。

提案手法

• オイラー角、回転行列（SO(3)）、クォータニオンの間で明示的な変換式を導出し、SE(3)ポーズ全体の定義域において一貫性を保つこと。
• 各表現を用いた2つのSE(3)ポーズの合成および3次元点へのポーズの適用方法を記述し、幾何的正確性を保持すること。
• SE(3)変換および合成におけるガウス的不確実性の伝播を分析し、各パラメータ化における共分散行列の変換方法を示すこと。
• マニフォールド上最小二乗最適化に不可欠なヤコビ行列を導出し、状態推定やボンドル調整に不可欠な基盤を提供すること。
• すべてのアルゴリズムをMRPT C++ライブラリに統合し、包括的なユニットテストと数値ヤコビ行列検証を用いて検証すること。
• 理論的分析とロボットソフトウェアスタックにおける実装の両方に対応できる一貫性のある数学的フレームワークを提示すること。

実験結果

リサーチクエスチョン

• RQ1 オイラー角、回転行列、クォータニオンという3つの主要な回転表現は、完全なSE(3)ポーズの文脈でどのように相互に関連しているか？
• RQ2 各表現を用いたSE(3)ポーズの合成および3次元点の変換に適した正しい効率的な公式は何か？
• RQ3 ポーズが他のポーズと合成されたり、点に適用された際に、SE(3)ポーズの不確実性（共分散）はどのように変化するか？
• RQ4 マニフォールド上最適化に必要な解析的ヤコビ行列は何か？また、それらはどのように信頼性を持って計算・検証できるか？
• RQ5 理論的フレームワークは、どのように生産的で実用的なMRPT C++コードにマッピングできるか？

主な発見

• 本論文は、オイラー角、回転行列、クォータニオンの間の完全で一貫性のある変換フレームワークを確立し、SE(3)ポーズ全体の構造を保持している。
• 3つの表現すべてにおいて、SE(3)ポーズの合成および3次元点の変換に適した明示的かつ検証済みの公式を提供している。
• 合成における共分散行列のヤコビアンベースの変換により、SE(3)ポーズの不確実性伝播が正確にモデル化されている。
• マニフォールド上最適化に必要なヤコビ行列は、数値推定とユニットテストにより検証されており、非線形最適化パイプラインでの信頼性を保証している。
• すべての数学的定式化はMRPT C++ライブラリに実装され、完全なテストカバレッジを備えており、ロボット工学およびビジョンアプリケーションへの即時利用が可能である。
• SE(3)表現の統合的取り扱いにより、状態推定やSLAMシステムにおける堅牢で効率的かつ数値的に安定した最適化が可能になった。