[논문 리뷰] A global exponential observer for velocity-aided attitude estimation

Philippe Martin, Ioannis Sarras외 2명|arXiv (Cornell University)|2016. 08. 26.

Inertial Sensor and Navigation참고 문헌 19인용 수 5

한 줄 요약

이 논문은 자이로스코프, 특정 가속도, 자기장 및 선형 속도의 몸체 기반 측정값을 사용하여 강체의 전역 지수 자세 및 속도 추정을 위한 단순하고 기하학적 제약이 없는 비선형 관측기를 제안한다. 엄격한 SO(3) 회전 대칭성을 완화하고 조정 가능한 이득 행렬을 갖는 수정된 오차 동역학을 적용함으로써, 관측기는 균일한 전역 지수 안정성을 확보하여 노이즈가 많고 왜곡된 측정값에서도 빠르고 강인한 수렴을 보장한다.

ABSTRACT

We propose a simple nonlinear observer for estimating the attitude and velocity of a rigid body from the measurements of specific acceleration, angular velocity, magnetic field (in body axes), and linear velocity (in body axes). It is uniformly globally exponentially convergent, and also enjoys other nice properties: global decoupling of pitch and roll estimation from magnetic measurements, good local behavior, and easy tuning. The observer is "geometry-free", in the sense that it respects only asymptotically the rotational geometry. The good behavior of the observer, even when the measurements are noisy and biased is illustrated in simulation.

연구 동기 및 목표

• 저비용·경량 로봇 차량의 제한된 센서 데이터를 이용한 정확하고 장기적인 자세 및 속도 추정 문제를 해결한다.
• MEMS 센서의 드리프트로 인해 시간이 지남에 따라 정확도가 떨어지는 전통적인 슈쿨러 효과 기반 인ertial 항법 시스템의 한계를 극복한다.
• 차량 전용 역학 모델에 의존하지 않는 일반화된 강인 관측기를 개발하여 다양한 플랫폼에 광범위하게 적용 가능하도록 한다.
• 이전 연구에서 달성한 거의 전역 점근적 안정성보다 뛰어난 균일한 전역 지수 안정성을 확보하면서도 단순성과 조정 용이성을 유지한다.
• 자기장 측정값으로부터 자세의 피치 및 롤 추정을 전역적으로 분리함으로써 자기장 간섭에 대한 강인성을 향상시킨다.

제안 방법

• 강체의 간단한 동역학 모델을 기반으로 한 비선형 관측기를 설계하며, 자세는 중력 벡터 γ와 자기장 벡터 β로 표현한다.
• 관측기를 시스템 동역학의 복제로 구성하고, 추정된 상태와 측정된 상태 간의 차이에 따라 시간에 따라 변하는 보정 항목을 도입한다.
• 오차 동역학을 조정하기 위해 K, L, M 세 개의 조정 행렬을 도입하며, K와 L은 속도 및 중력 벡터 추정 오차에 작용하고, M은 자기장 오차에 작용한다.
• γ, v, β의 추정 오차에 대한 제곱항을 포함하는 리아푸노프 함수를 사용하여 안정성 증명을 수행하며, 에너지 함수는 오차 동역학의 분리된 구조를 명시적으로 반영하도록 설계되었다.
• 관측기 구조를 유도하기 위해 불변 다양체 관측기 방법론을 적용하였으며, 이는 매 시간 단계에서 대칭성을 강제하지 않으면서도 회전 대칭성을 점진적으로 유지할 수 있도록 한다.
• 관측기가 더 큰 공간에서 진동하도록 하여 SO(3)에 대한 기하 제약 조건을 완화함으로써 강인성을 향상시키고 전역 지수 수렴을 가능하게 한다.

실험 결과

연구 질문

• RQ1 속도 보조 자세 추정에서 균일한 전역 지수 안정성을 확보하는 비선형 관측기를 설계할 수 있는가? 기존의 거의 전역 점근적 안정성을 갖는 관측기보다 우수한 성능를 발휘할 수 있는가?
• RQ2 관측기를 노이즈와 왜곡에 강인하게 만들면서도 단순성과 조정 용이성을 유지할 수 있는가?
• RQ3 피치 및 롤 추정이 자기장 측정값으로부터 얼마나 전역적으로 분리될 수 있는가? 이는 자기장 간섭에 대한 저항력을 향상시킬 수 있는가?
• RQ4 관측기 설계에서 엄격한 SO(3) 기하 구조를 완화했을 때 수렴 속도와 강인성에 어떤 영향을 미치는가?
• RQ5 일반적인 관측기 구조를 차량 전용 모델링 없이 다양한 로봇 플랫폼에 적용할 수 있는가?

주요 결과

• 이득 행렬 K, L, M의 대칭 부분이 양의 정부호이면, 제안된 관측기는 추정 오차 시스템에 대해 균일한 전역 지수 안정성을 확보한다.
• 관측기는 자기장 측정값으로부터 피치 및 롤 추정을 전역적으로 분리함으로써 강인성을 향상시킨다. 이는 중력 벡터 γ가 β와 독립적으로 추정되기 때문이다.
• 시뮬레이션 결과는 노이즈가 많고 왜곡된 측정값 하에서도 뛰어난 성능을 보이며, 빠른 수렴과 근사적으로 없는 정적 오차를 보인다.
• SO(3)에 대한 기하 제약 조건을 완화함으로써 이전의 불변 관측기 설계보다 수렴 증명이 훨씬 간단해졌다.
• 관측기는 우수한 국소적 성능를 유지하며 조정이 용이하며, 초기 조건에 민감하지 않다.
• 조정 매개변수 K, L, M의 선택을 통해 수렴 속도와 강인성 사이의 트레이드오���을 가능하게 한다.