Pitot-Aided Attitude and Air Velocity Estimation with Almost Global Asymptotic Stability Guarantees

기술 요약: 거의 전역 점근적 안정성(AGAS) 보장을 갖춘 피토관 보조 자세 및 공력 속도 추정

문제 정의
고정익 무인 항공기(UAV)를 위한 신뢰할 수 있는 자세 추정은 GNSS(글로벌 위성 항법 시스템)가 제한되거나 동역학이 격렬한 환경에서 매우 까다로운 과제이다. IMU(관성 측정 장치)에 의존하는 표준 방식은 가속도계로부터 중력 방향을 추론하는 경우가 많은데, 이는 지속적인 전진 비행이나 공격적인 기동 시 발생하는 비중력 가속도가 유의미할 때 오차가 발생한다. 속도 보조 자세(VAA) 추정은 해결책을 제시하지만, 많은 기존 방법론은 완전한 속도 측정값(관성 좌표계 또는 바디 고정 좌표계)을 가정하므로 소형 UAV에는 제약이 따른다. 고정익 UAV는 일반적으로 종방향 바디 축에 정렬된 단일 축 피토관을 통해 공력 속도를 측정한다. 피토관과 IMU 데이터를 결합하려는 이전의 시도들은 미흡하게 알려진 공력 파라미터에 의존하거나, 국소적 수렴 보장만을 갖는 관측기를 생성했다. 또한, 단일 축 피토 측정은 축 대칭성으로 인해 관성 헤딩 참조 없이는 요(yaw) 각도를 관측할 수 없으며, 이로 인해 추정이 축소된 자세(tilt)로 제한된다.

방법론
저자들은 IMU, 적어도 하나의 피토관 측정값, 그리고 지자기 센서 데이터를 활용하여 공력 보조 틸트(tilt) 추정과 전체 자세 추정을 분리하는 2단계 캐스케이드 관측기 구조를 제안한다.

1. 1단계: 틸트 및 공력 속도 추정 (리카티 관측기)

   • 시스템은 "틸트"를 바디 고정 좌표계에서 표현된 중력 방향($z = R^\top e_3$)으로 정의한다.
   • 공력 속도 역학(dynamics)과 틸트 역학을 결합함으로써, 저자들은 증강된 상태 변수에 바디 고정 공력 속도 벡터($V_a$)와 틸트 벡터($z$)를 포함하는 선형 시변(LTV) 시스템을 구성한다.
   • 연속 시간 리카티/칼만 유형의 관측기가 설계되어 이 증강된 상태를 추정한다. 이 관측기는 피토 측정값( $V_a$의 스칼라 투영)을 출력으로 사용한다.
   • 이 단계의 안정성은 LTV 시스템의 **균등 관측 가능성(Uniform Observability, UO)**에 달려 있다. 저자들은 완만한 흥분 조건(특히, 차량 방향에 대한 피토 프로브 방향의 지속적 흥분) 하에서 추정 오차 역학이 전역 균등 지수 안정(GES)함을 증 proves 한다.
   • 단일 축 피토관의 관측 제한(전체 자세를 위해 복잡한 요 및 피치 기동이 필요함)을 해결하기 위해, 저자들은 제로 사이드슬립 의사 측정값($V_{a,2} = 0$)을 도입한다. 이는 협조 비행(coordinated flight)에서 유효하며, 측정 벡터를 효과적으로 증강하여 흥분 요구 사항을 지속적인 요(yaw) 운동만으로 완화한다.

2. 2단계: $SO(3)$ 상의 비선형 관측기를 이용한 전체 자세 추정

   • 1단계에서 추정된 틸트 벡터($\hat{z}$)는 $SO(3)$상에 정의된 비선형 관측기를 통해 지자기 측정값($m_B$)과 융합된다.
   • 기하학적 필터링 원리에 기반한 이 관측기는 피토 측정만으로는 불가능한 요(yaw) 모호성을 해결한다.
   • 보정 항은 추정된 틸트와 알려진 관성 자기장 벡터를 활용하여 자세 추정을 구동한다.

주요 기여

• 캐스케이드 구조: 본 논문은 공력 속도/틸트 추정과 전체 자세 추정을 분리하는 통합 프레임워크를 도입하여, 상호 연결된 시스템에 대한 엄격한 안정성 분석을 가능하게 한다.
• AGAS 보장: 국소적 수렴 결과만을 제공했던 기존의 피토 기반 접근 방식과 달리, 본 연구는 전체 캐스케이드 구조에 대해 **거의 전역 점근적 안정성(AGAS)**을 확립한다. 이는 첫 번째 단계에서 UO 조건을 만족시키고, 두 번째 단계에서 $SO(3)$ 관측기의 위상적 특성을 활용함으로써 달성된다.
• 제로 사이드슬립 증강: 제로 사이드슬립 제약을 의사 측정값으로 포함하는 것이 시스템의 관측 가능성을 크게 향상시켜, 상태 수렴을 위한 공격적인 기동에 대한 의존도를 낮춘다는 것을 저자들은 입증한다.
• 엄격한 분석: 저자들은 증강된 LTV 시스템에 대한 균등 관측 가능성에 대한 상세한 증명을 제공하며, 평형점의 안정성을 확립하여 불안정한 평형점 집합이 측도 제로(measure-zero)임을 보여준다.

실험 결과
제안된 관측기는 IMU, 전방 정렬 피토관, 지자기 센서를 장착한 MakeFlyEasy Fighter VTOL UAV의 실제 비행 데이터를 사용하여 검증되었다. 실험은 견고성을 테스트하기 위해 바람이 부는 환경에서 수행되었다. 두 가지 구성이 비교되었다:

1. 구성 1: 제로 사이드슬립 의사 측정값을 활용함.
2. 구성 2: 단일 축 피토 측정에만 의존함.

결과:

• 구성 1은 상당한 피치 변화 중에도 공력 속도 추정 오차가 약 3 m/s로 수렴함을 보여주었다. 관측 가능성 그람 행렬(Gramian)의 조건수(condition number)가 낮게 유지되었는데, 이는 견고한 관측 가능성을 나타낸다.
• 구성 2는 큰 제곱평균제곱근 오차(측면 약 12 m/s, 수직 약 9 m/s)와 열악한 수치적 조건성을 보였으며, 이는 흥분이 제한될 때 관측 가능성이 상실됨을 확인시켜 준다.
• 협조 비행 구간에서 구성 1의 모든 추정 오차는 유계(bounded) 상태를 유지하며 0으로 수렴하였고, 이는 이론적인 AGAS 주장을 검증한다. 이 결과는 의사 측정값이 약한 흥분 상황에서도 관측 가능성을 회복시키는 효과적인 메커니즘으로 작용함을 확인시켜 준다.

의의 및 주장
본 논문은 기존의 피토 보조 추정 프레 framework를 국소적 수렴 결과를 넘어 확장한다고 주장한다. 엄격한 안정성 보장을 갖춘 전체 공력 속도 및 자세 추정을 위한 통합 프레임워크를 제공함으로써, 본 연구는 GNSS 결핍 환경에서의 UAV 항법에 대한 중요한 간극을 메운다. 저자들은 본 접근 방식이 복잡한 공력 모델이나 완전한 속도 측정을 요구하지 않고도 단일 축 피토 센싱의 한계를 효과적으로 극복한다고 주장한다. 이론적 분석은 유계되고 느리게 변화하는 바람을 가정하며 센서 바이어스를 명시적으로 추정하지는 않지만, 바람이 부는 환경에서의 실험적 검증은 관측기의 실질적인 견고성을 입증한다. 저자들은 풍향 성분과 관성 센서 바이어스의 공동 추정이 자연스러운 향후 연구 방향임을 밝힌다.