出力同変性を利用した視覚SLAMのオブザーバ設計
An Observer Design for Visual Simultaneous Localisation and Mapping with Output Equivariance
対称性を活用し、逆深度計測を用いた視覚SLAM向けの非線形オブザーバを設計。拡張カルマンフィルタと同等精度を保ちつつ計算量を線形に抑え、堅牢性も向上させた。
著者: Pieter van Goor, Robert Mahony, Tarek Hamel, Jochen Trumpf
分類: cs.RO
原文アブストラクト
Visual Simultaneous Localisation and Mapping (VSLAM) is a key enabling technology for small embedded robotic systems such as aerial vehicles. Recent advances in equivariant filter and observer design offer the potential of a new generation of highly robust algorithms with low memory and computation requirements for embedded system applications. This paper studies observer design on the symmetry group proposed in previous work by the authors, in the case where inverse depth measurements are available. Exploiting this symmetry leads to a simple fully non-linear gradient based observer with almost global asymptotic and local exponential stability properties. Simulation experiments verify the observer design, and demonstrate that the proposed observer achieves similar accuracy to the widely used Extended Kalman Filter with significant gains in processing time (linear verses quadratic bounds with respect to number of landmarks) and qualitative improvements in robustness.
