[論文レビュー] Look, no Beacons! Optimal All-in-One EchoSLAM

Miranda Kreković, Ivan Dokmanić+1 more|arXiv (Cornell University)|Aug 31, 2016

Robotics and Sensor-Based Localization参考文献 17被引用数 6

ひとこと要約

この論文では、1つの同所配置の全方向的発信源および受信機からの1次エコー遅延時間（TOA）測定値のみを用いて、2次元の凸多角形部屋の幾何構造とデバイスの軌道を同時に最適に推定するエコーアルゴリズム「EchoSLAM」を提示する。問題をストレス関数に類似したコスト関数を用いた双線形非凸最適化として定式化することにより、事前の軌道知識やビーコンがなくても、ノイズに強く、グローバルに最適な共同推定を達成する。

ABSTRACT

We study the problem of simultaneously reconstructing a polygonal room and a trajectory of a device equipped with a (nearly) collocated omnidirectional source and receiver. The device measures arrival times of echoes of pulses emitted by the source and picked up by the receiver. No prior knowledge about the device's trajectory is required. Most existing approaches addressing this problem assume multiple sources or receivers, or they assume that some of these are static, serving as beacons. Unlike earlier approaches, we take into account the measurement noise and various constraints on the geometry by formulating the solution as a minimizer of a cost function similar to \emph{stress} in multidimensional scaling. We study uniqueness of the reconstruction from first-order echoes, and we show that in addition to the usual invariance to rigid motions, new ambiguities arise for important classes of rooms and trajectories. We support our theoretical developments with a number of numerical experiments.

研究の動機と目的

• 最小限の音響測定値から、事前の軌道知識やビーコンがなくても、部屋の幾何構造とデバイスの軌道を再構築する課題に対処すること。
• 1次エコーTOAデータのみを用いて、部屋の形状とセンサ位置を同時に推定する非凸最適化問題として問題を定式化すること。
• 同所配置センシングおよび双線形制約に適応したストレスに類似したコスト関数を設計することで、測定ノイズに対して耐性を持つこと。
• 数値実験を通じて、非凸性および潜在的な幾何的あいまいさが存在する状況でも、グローバル最適性と計算効率を示すこと。
• 標準的な剛体運動不変性を超えた再構築の一意性に関する幾何的あいまいさを調査・特徴付けること。

提案手法

• 各壁の反射が壁に対して鏡像に配置された仮想発信源に対応する画像源法を用いて部屋をモデル化する。
• 1次エコーの到達時間（TOA）をマイク位置と壁の幾何構造の関数として表現する：$\tau_{i,j} = \|\widetilde{\mathbf{s}}_{i,j} - \mathbf{r}_i\| / c$。
• 測定値と予測値のTOA距離の差を最小化する、多次元スケーリングのストレスに類似したコスト関数を定式化する。
• 変数 $\mathbf{u}_{i,j} = [q_j, u_{i,j}]^T$ を用いてコスト関数を双線形形式に再定式化する。ここで $q_j$ は壁パラメータを表し、$u_{i,j}$ は $\mathbf{r}_i$ の壁法線への射影を表す。
• IPOPTを用い、ラインサーチフィルタ法を組み合わせることで、弱い仮定のもとでグローバル収束を保証し、非凸問題の効率的解法を可能にする。
• IPOPTによる暗黙的なMcCormick緩和技術を用いて双線形制約を処理し、ノイズ状態でも耐性を持つようにする。

実験結果

リサーチクエスチョン

• RQ1 同所配置の発信源・受信機からの1次エコーTOA測定値から、部屋の幾何構造が、どのような幾何的および軌道的条件下で一意に再構築可能か。
• RQ2 事前の軌道知識がなくても、部屋の幾何構造とデバイスの軌道を、グローバルに最適な非凸最適化問題としてどのように定式化できるか。
• RQ3 特定の部屋タイプや軌道に対して、剛体運動不変性を超えた新たな再構築のあいまいさはどのようなものか、そしてそれらはどのように生じるか。
• RQ4 同所配置センシングに適応したストレスに類似したコスト関数は、現実的なノイズレベル下でも、ロバストかつグローバルに最適な推定を達成できるか。
• RQ5 測定ノイズの増加に伴い、部屋の幾何構造およびセンサ位置の推定誤差はどのようにスケーリングするか。

主な発見

• 本手法は、ビーコンや事前の軌道知識が一切不要な状況下でも、1つの同所配置発信源・受信機からの1次エコーTOA測定値のみを用いて、部屋の幾何構造とデバイスの軌道をグローバルに最適に共同推定する。
• 数値実験の結果、非凸性が存在する状況下でも、IPOPTがすべてのテストケースで信頼性の高い性能を示し、ミリ秒スケールでグローバル最適解に収束することが確認された。
• $N=8$ 個の測定点およびガウスノイズ $\mathcal{N}(0, 0.05^2)$ の条件下で、部屋の頂点位置の平均推定誤差は0.1メートル未満であり、誤差はノイズ標準偏差に線形に増加した。
• ノイズに対して高い耐性を示した：SNRが約30 dBのときの部屋の幾何構造誤差は約0.02メートル、SNRが約10 dBのときには約0.15メートルに増加した（各ノイズレベルで1000回の実験）。
• 特定の構成（例：長方形部屋や平行四辺形部屋における測定点が同一直線上に並ぶ場合）では、異なる部屋の形状が同一のエコー集合を生成する幾何的あいまいさが観察された。
• コスト関数の双線形構造のおかげで、IPOPTを用いた効率的なグローバル最適化が可能であり、補助変数や複雑な緩和手法の必要がなく、ノイズレベルの上昇に対しても良好なスケーラビリティを示した。