[論文レビュー] manif: A micro Lie theory library for state estimation in robotics applications

Jérémie Deray, Joan Solà|arXiv (Cornell University)|Jan 24, 2020

Robotics and Sensor-Based Localization被引用数 236

ひとこと要約

この論文では、ロボティクスの状態推定に特化した最小限で実用的なLie理論のサブセットを実装するC++テンプレートのみで構成されるライブラリmanifを紹介する。回転群SO(3)、剛体群SE(3)、および関連群における指数・対数写像、ヤコビアン、群演算の基本的コンセプトを簡素化し、SLAM、ビジュアルオドメトリ、インertialナビゲーションにおける不確実性の正確で効率的な伝搬を、閉形式の式と再利用可能なコードコンponentsによって可能にする。

ABSTRACT

<strong>manif</strong> is a header-only C++11 Lie theory library for state-estimation targeted at robotics applications. It has been designed for an easy integration to larger projects: A single dependency on Eigen, header-only for easy integration, templated on the underlying scalar type so that one can use its own, and C++11, since not everyone gets to enjoy the latest C++ features, especially in industry. The library provides simple interfaces to the most common operations on Lie groups in state estimation together with an analytic computation of Jacobians for all the operations.

研究の動機と目的

• 抽象的なLie理論と実用的なロボティクスの状態推定の間のギャップを埋めるために、最も重要な要素のみを抽出すること。
• 直感的な理解と正しい実装を可能にする教育的で最小限のフレームワークを提供すること。
• 主なロボティクス分野のLie群のコアな演算（Exp、Log、アドジョイント、ヤコビアン）を実装する包括的で再利用可能なC++ライブラリ（manif）を提供すること。
• 非線形最適化における大きな障壁となるヤコビアンの計算を、左/右ヤコビアンおよび群作用の閉形式表現を提供することで簡素化すること。
• 厳密な多様体ベースのモデリングを通じて、SLAM、ビジュアルオドメトリ、インertialナビゲーションにおける堅牢で一貫性があり、数値的に安定した推定を実現すること。

提案手法

• ロボティクス推定に十分な最小限のLie理論のサブセットに焦点を当て、Lie括弧や完全な群表現といった高度な代数的構造は除外する。
• 指数写像、接空間、点への群作用を通じて、幾何的・代数的・位相的直感を用いて、SO(3)、SE(3)などのLie群を説明する。
• 回転群および剛体運動群におけるExp(τ)とLog(M)のための閉形式表現を導出し、Rodriguesの公式と行列指数を用いる。
• 行列微積分と群作用の微分を用いて、ヤコビアン行列（左、右、アドジョイント、逆、合成）を導出し、実装する。
• すべての演算を型安全で汎用的なインターフェースで公開するC++テンプレートのみのライブラリ（manif）を導入し、コンパイル時最適化と再利用を可能にする。
• SO(2)、SO(3)、SE(2)、SE(3)、クォータニオン、並進群（R^n、T(n)）のための公式が含まれる、広範な参考付録を提供する。ヤコビアンと逆演算を含む。

実験結果

リサーチクエスチョン

• RQ1 ロボティクスの実務家が正しいかつ効率的な状態推定を可能にするために、Lie理論の最小限で実用的なサブセットを抽出し、教育的に提供する方法は何か？
• RQ2 SLAMおよびビジュアルオドメトリにおける堅牢な推定に必要な最小限のLie理論的演算（Exp、Log、ヤコビアン）は何か？
• RQ3 非線形最適化においてしばしば誤りを生じやすいヤコビアンの計算を、閉形式表現を通じて簡素化し、再利用可能にする方法は何か？
• RQ4 型安全で効率的かつ拡張可能にLie群の演算を公開できる、軽量でテンプレートのみのC++ライブラリを設計できるか？
• RQ5 数学的厳密性を損なわず、幾何的・運動的アナロジーを通じて抽象的なLie群の概念を直感的かつアクセス可能な形にできるか？

主な発見

• 微小Lie理論フレームワークは、ロボティクスの状態推定に必要な最小限の要素にまで、完全なLie理論の複雑さを簡略化することに成功した。
• SO(3)およびSE(3)の左・右ヤコビアンの閉形式表現が導出・検証され、EKFおよび非線形ソルバーにおける正確な不確実性伝搬を可能にした。
• manifライブラリは、SO(2)、SO(3)、SE(2)、SE(3)、クォータニオン、並進群のためのExp、Log、アドジョイント、ヤコビアンの型安全でテンプレートベースの実装を提供する。
• EKFや非線形最適化などの状態推定アルゴリズムの効率的で正しい実装をサポートし、群演算のヤコビアンブロックを検証済みで提供する。
• 指数写像と接空間表現の使用により、SLAMおよびビジュアルオドメトリにおける安定で一貫性があり、数値的に堅牢な推定が可能になった。
• 最小限のLie理論的アプローチが高精度な推定に十分であることが実証され、実装エラーが著しく減少し、アルゴリズムの安定性が向上した。