[論文レビュー] Technical report on Optimization-Based Bearing-Only Visual Homing with Applications to a 2-D Unicycle Model

Roberto Tron, Kostas Daniilidis|arXiv (Cornell University)|Feb 14, 2014

Robotic Path Planning Algorithms被引用数 5

ひとこと要約

本稿では、リャプノフ関数の勾配に基づく最適化に基づく、距離情報やコンパスに依存しない、全空間への収束を保証する視覚的ホームイン制御則を提案する。平均特徴点ベクトル法の全空間収束性を証明し、スライディングモード制御を用いて非ホロノミックなユニサイクルモデルへの拡張を実現し、測定方向のみを用いたロバストなナビゲーションを可能にするとともに、ノイズ耐性のための感度解析を実施する。

ABSTRACT

We consider the problem of bearing-based visual homing: Given a mobile robot which can measure bearing directions with respect to known landmarks, the goal is to guide the robot toward a desired "home" location. We propose a control law based on the gradient field of a Lyapunov function, and give sufficient conditions for global convergence. We show that the well-known Average Landmark Vector method (for which no convergence proof was known) can be obtained as a particular case of our framework. We then derive a sliding mode control law for a unicycle model which follows this gradient field. Both controllers do not depend on range information. Finally, we also show how our framework can be used to characterize the sensitivity of a home location with respect to noise in the specified bearings. This is an extended version of the conference paper [1].

研究の動機と目的

• 既知の特徴点の方向測定のみを用いて、全空間への収束を保証する制御則の開発。
• 従来理論的根拠が不足していた、広く用いられている平均特徴点ベクトル（ALV）法の厳密な収束証明の提供。
• スライディングモード制御を用いて、非ホロノミックなユニサイクルモデルへのフレームワークの拡張により、勾配場の軌道追従を保証。
• 方向測定ノイズに対するホーム位置の感度を、分散比（σ²_x / σ²_y）のヒートマップとして可視化することで定量的解析。
• 距離情報やグローバルコンパスに依存しない実用的展開を可能にするために、フレームワークの設計。

提案手法

• 制御則は、適切に選ばれたクラスに属するコスト関数の勾配として導出され、一意の最小化点への全空間収束を保証する。
• コスト関数は、現在の方向ベクトルとホーム方向ベクトルの間の角度差に、関数fを適用した形で構築される。
• リャプノフ安定性理論を用いて全空間収束を証明し、コスト関数の凸性および微分可能性に関する十分条件を提示。
• ユニサイクルモデルの場合、勾配の微分に関する下限と上限のみを用いて、勾配場を追従するスライディングモード制御則を設計。
• フレームワークにより、ホーム位置における分散成分比（σ²_x / σ²_y）の計算が可能となり、ヒートマップとして可視化される感度解析が実現。
• 異なる特徴点配置と初期条件を想定した2次元環境におけるシミュレーションにより、手法の有効性を検証。

実験結果

リサーチクエスチョン

• RQ1 方向測定のみを用いて、証明可能な全空間収束性を有する視覚的ホームイン制御則を設計可能か？
• RQ2 提案されたフレームワークは、実験的に成功している平均特徴点ベクトル（ALV）法に理論的根拠を提供できるか？
• RQ3 制御権限が制限された非ホロノミックなユニサイクル動力学に、勾配に基づく制御則をどのように適応可能か？
• RQ4 方向測定ノイズに対するホーム位置の感度は何か？ また、定量的に可視化可能か？
• RQ5 エピポーラ幾何学を用いて相対姿勢推定が可能であるため、コンパスに依存しない設定への拡張は可能か？

主な発見

• 提案された制御則は、距離情報やコンパス情報が欠落している状況下でも、任意の初期状態からホーム位置への漸近的全空間収束を保証する。
• 平均特徴点ベクトル（ALV）法は、提案フレームワークの特別な場合として形式的に回復され、これが初めての全空間収束証明となる。
• シミュレーションでは、ユニサイクルモデルが、ロボットが後退・旋回後に前進を要する状況を含め、全テスト初期姿勢からもホーム位置に到達している。
• スライディングモードコントローラーは勾配フローを効果的に追従し、軌道が勾配場の線に一致しており、制御制約に対するロバストネスが確認された。
• σ²_x / σ²_y のヒートマップは、特徴点が周囲に配置された場合にホーム位置が最も安定しており、同一直線上に配置された配置では安定性が低下することを示している。
• 視覚オドメトリが正確に並進を推定できなくても、制御則は依然としてユニサイクルを正しいホーム位置に誘導することができ、視覚推定誤差に対しても耐性があることが示された。