[논문 리뷰] Position USBL/DVL Sensor-based Navigation Filter in the presence of Unknown Ocean Currents

M. Luísa Morgado, Pedro Batista외 2명|arXiv (Cornell University)|2010. 08. 26.

Underwater Vehicles and Communication Systems참고 문헌 9인용 수 4

한 줄 요약

이 논문은 평면파 근사 없이 직접 비선형 USBL 및 DVL 센서 읽기 값을 사용하여 AUV의 전역 점진적 안정성(GAS)을 확보하는 위치 항법 필터를 제안한다. 상태 증강을 통해 선형 시간 변화 시스템(LTV)을 유도함으로써, 전진자석 위치와 알 수 없는 해류 속도를 안정적으로 추정할 수 있으며, EKF 성능을 재현하면서도 오차가 0으로 수렴함을 보장한다.

ABSTRACT

This paper presents a novel approach to the design of globally asymptotically stable (GAS) position filters for Autonomous Underwater Vehicles (AUVs) based directly on the nonlinear sensor readings of an Ultra-short Baseline (USBL) and a Doppler Velocity Log (DVL). Central to the proposed solution is the derivation of a linear time-varying (LTV) system that fully captures the dynamics of the nonlinear system, allowing for the use of powerful linear system analysis and filtering design tools that yield GAS filter error dynamics. Simulation results reveal that the proposed filter is able to achieve the same level of performance of more traditional solutions, such as the Extended Kalman Filter (EKF), while providing, at the same time, GAS guarantees, which are absent for the EKF.

연구 동기 및 목표

• 기존의 EKF나 평면파 기반 칼만 필터에서 관찰되는 전역 점진적 안정성(GAS)의 부재를 해결한다.
• 근사 없이 직접 비선형 USBL 범위 및 RDOA 측정치를 사용하는 항법 필터를 개발한다.
• 알 수 없는 해류와 센서 노이즈가 존재하더라도 위치 및 해류 속도 추정 오차가 0으로 수렴하도록 안정성을 확보한다.
• 특히 근접 거리에서 정밀 작업(예: 도킹)을 위한 전진자석 위치 추정을 정확하게 수행할 수 있도록 한다.
• 운동 자극 제약 없이 단일 범위 추정 기반 이전 연구를 다중 수신기 USBL 어레이로 확장한다.

제안 방법

• USBL 범위 및 RDOA 측정치, DVL 속도 읽기 값을 사용한 AUV 항법을 위한 비선형 시스템 모델을 수립한다.
• 상태 증강을 통해 비선형 동역학을 정확히 반영하는 선형 시간 변화(LTV) 시스템을 유도한다.
• LTV 모델을 기반으로 전역 점진적 안정성 보장 오차 동역학을 갖는 칼만 필터를 설계한다.
• 범위 및 RDOA 측정치의 선형화를 피하기 위해 이를 필터 구조에 직접 통합한다.
• DVL 읽기 값에 미치는 영향을 보정하기 위해 알 수 없는 해류를 상태 증강으로 포함시킨다.
• DVL(0.2% + 1 mm/s), 고속도계(0.05 deg/s), USBL(1 m 범위, 6 mm RDOA 정밀도) 등의 현실적인 센서 노이즈 모델을 적용한다.

실험 결과

연구 질문

• RQ1 비선형 USBL 및 DVL 측정치를 사용하여 AUV 위치 추정에 대해 전역 점진적 안정성(GAS)을 보장하는 항법 필터를 설계할 수 있는가?
• RQ2 USBL RDOA 측정치에 대해 평면파 근사를 피할 경우, 특히 근접 거리에서 오차 수렴이 향상되는가?
• RQ3 USBL/DVL 항법 문제의 비선형 동역학을 완전히 표현할 수 있는 선형 시간 변화(LTV) 시스템을 유도할 수 있는가?
• RQ4 제안된 LTV 칼만 필터의 성능은 EKF 및 평면파 기반 칼만 필터와 비교해 안정상태 오차 측면에서 어떻게 다른가?
• RQ5 제안된 필터는 현실적인 센서 노이즈와 알 수 없는 해류가 존재하더라도 여전히 전역 점진적 안정성(GAS) 오차 동역학을 유지하는가?

주요 결과

• 제안된 LTV 칼만 필터는 안정상태 위치 오차 RMS가 x축 0.0880 m, y축 0.0837 m, z축 0.1101 m를 기록하며, EKF 및 KFPW와 동일한 성능을 보인다.
• EKF는 약간 낮은 x축 오차(0.0611 m)를 보였지만 전역 점진적 안정성 보장을 하지 못한다.
• 평면파 기반 칼만 필터(KFPW)는 높은 x축 오차(0.1122 m)를 보이며, 근사에 기인한 편향으로 인해 오차가 0으로 수렴하지 않는다.
• 모든 필터가 유사한 안정상태 성능을 보이지만, 오직 제안된 LTV 필터만이 전역 점진적 안정성을 보장한다.
• LTV 필터의 초기 수렴은 매끄럽고 빠르며, 그림 3과 4에서 보듯이 위치 및 해류 오차가 시간이 지남에 따라 0으로 수렴한다.
• 이전의 단일 범위 방법과 달리, 지속적인 자극이나 운동 제약 없이도 안정된 오차 동역학을 유지한다.