[논문 리뷰] Look, no Beacons! Optimal All-in-One EchoSLAM

Miranda Kreković, Ivan Dokmanić외 1명|arXiv (Cornell University)|2016. 08. 31.

Robotics and Sensor-Based Localization참고 문헌 17인용 수 6

한 줄 요약

이 논문은 단일의 동위치 광역 방출원과 수신기가 제공하는 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 거리와 예측된 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차 에코 ToA 측정값만을 사용하여 실내 기하학적 구조와 기기 궤적을 전역 최적의 공동 추정을 달성한다.
• 수치 실험 결과, 알고리즘은 비볼록성에도 불구하고 밀리초 내로 전역 최적해에 수렴하는 것으로 나타났으며, IPOPT는 모든 시험 케이스에서 신뢰할 수 있는 성능을 보였다.
• 8개의 측정점과 정규 노이즈 $\mathcal{N}(0, 0.05^2)$ 조건에서 실내 정점 위치의 평균 추정 오차는 0.1미터 이하였고, 오차는 노이즈 표준편차와 선형적으로 증가하였다.
• 이 방법은 노이즈에 강건하다: 신호 대 잡음비(SNR) 약 30 dB일 때 실내 기하학적 구조의 추정 오차는 약 0.02m에서 시작하여 SNR 약 10 dB일 때 약 0.15m로 증가하였으며, 각 노이즈 수준당 1000회의 실험을 수행하였다.
• 특정 구성—예를 들어 직사각형 실내에서 공선성 있는 측정점 또는 평행사변형 실내—에서는 서로 다른 실내 형상이 동일한 에코 세트를 생성하여 기하학적 모호성이 관찰되었다.
• 비용 함수의 이중선형 구조 덕분에 IPOPT를 통해 효율적인 전역 최적화가 가능했으며, 보조 변수나 복잡한 허용 범위 없이도 수행되었고, 노이즈 수준 증가에 따라 잘 스케일링되었다.