점군과 속도 센서를 이용한 유한시간 안정 포즈 추정

초록

본 논문은 3차원 점군과 몸체에 부착된 속도 센서(자이로·가속도계)만을 이용해, 회전·병진 운동을 동시에 수행하는 강체의 자세와 위치, 그리고 속도를 유한시간 안에 수렴하도록 설계된 전역적인 전 상태 관측기(FTS‑PE)를 제안한다. Lie 그룹 SE(3)와 그 접공간 TSE(3) 위에서 직접 설계된 비선형 관측기는 좌표계 변환이나 (듀얼)쿼터니언을 사용하지 않아 특이점과 언와인딩 현상을 피하고, 측정 잡음에 대한 강인성을 보장한다. 또한 전이속도 측정이 없을 경우에도 점군과 각속도만으로 동작하도록 확장된 버전을 제공한다. 수치 시뮬레이션과 ZED 2i 스테레오 깊이 카메라 실험을 통해 기존의 듀얼‑쿼터니언 EKF 및 변분 기반 추정기와 비교했을 때 수렴 속도와 잡음 저항성에서 우수함을 입증한다.

상세 분석

본 연구는 강체의 자세와 위치를 동시에 추정하는 문제를 SE(3) 라는 비선형 매니폴드 위에서 직접 다루었다는 점에서 이론적 의의가 크다. 기존의 대부분의 추정기들은 로컬 좌표(오일러 각)나 단일 사원수·듀얼‑쿼터니언을 사용해 특이점이나 이중 커버링 문제에 직면했지만, 저자들은 SE(3)와 그 리 대수 se(3)를 이용해 전역적인 상태 표현을 유지하였다. 핵심은 Morse‑Lyapunov 함수를 설계해 추정 오차가 유한시간 내에 영점으로 수렴함을 증명한 것이다. 특히, 관측기에 사용된 비용함수는 가중 대칭 행렬을 통한 Wahba‑형식의 일반화이며, 이 행렬이 특정 조건을 만족하면 비용함수가 Morse 함수가 되어 전역적인 안정성을 확보한다.

속도 센서가 제공하는 각속도와 (선택적으로) 병진속도를 이용해 관측기의 내부 동역학을 구성하고, 점군으로부터 얻은 상대 위치 벡터 쌍을 통해 회전 부분을 추정한다. 측정 잡음은 유한시간 안정성 분석에 포함되어, 유계 잡음 하에서도 추정 오차가 유한시간 안에 제한된 집합으로 수렴함을 보였다. 또한, 관측기는 연속적이며 거의 전역(AGFTS) 수렴을 보장하므로, 초기 오차가 거의 모든 경우에 대해 빠르게 수렴한다.

이론적 결과를 검증하기 위해 저자들은 변분 기반 추정기(VPE)와 듀얼‑쿼터니언 EKF와의 비교 실험을 수행했다. 시뮬레이션에서는 초기 오차가 큰 경우에도 FTS‑PE가 0.2 s 이내에 오차를 10⁻³ 수준으로 감소시켰으며, 잡음이 존재하는 경우에도 RMS 오차가 기존 방법보다 30 % 이상 낮았다. 실험에서는 ZED 2i 스테레오 카메라와 내장 IMU를 사용해 실제 점군과 각속도 데이터를 수집했으며, 동일한 설정에서 FTS‑PE가 실시간(≈30 Hz)으로 안정적인 추정값을 제공함을 확인했다.

요약하면, 이 논문은 Lie‑group 기반의 전역적인 전 상태 관측기를 설계하고, 유한시간 안정성 및 잡음 강인성을 수학적으로 증명함과 동시에 실험적으로 검증한 종합적인 연구라 할 수 있다.