불확실성 인식 단일 앵커 UWB 기반 삼차원 UAV 추적

초록

본 논문은 UAV에 장착된 다중 안테나 단일 앵커 UWB 시스템을 이용해 이동 목표물을 3차원으로 추적한다. 범위와 3D 방위 측정을 결합한 강인한 팩터 그래프 추정기로 목표 위치와 공분산을 실시간으로 얻고, 이 공분산을 활용해 거리와 안전 마진을 동적으로 조정하는 CLF‑CBF 기반 제어기를 설계한다. 실내 복도 환경에서 시뮬레이션과 실제 비행 실험을 통해 측정 이상치와 NLoS 상황에서도 안정적인 거리 유지와 안전성을 검증한다.

상세 분석

이 연구는 단일 앵커 UWB가 제공하는 범위와 3차원 방위(azimuth, elevation) 정보를 동시에 활용한다는 점에서 기존 다중 앵커 기반 방법과 차별화된다. 다중 안테나 배열을 통해 얻은 방위는 단일 벡터가 아닌 단위 구면 위의 방향벡터로 표현되며, 이는 팩터 그래프 내에서 탄탄한 기하학적 잔차 정의를 가능하게 한다. 특히, 방위 잔차를 접선 공간에 투영하고 Cauchy 손실 함수를 적용함으로써 다중 경로와 NLoS에 의해 발생하는 큰 이상치를 효과적으로 억제한다.

팩터 그래프는 초기 상태에 대한 prior factor, 목표 동역학에 기반한 dynamic factor, 범위 측정에 대한 range factor, 그리고 위에서 언급한 robust bearing factor 로 구성된다. iSAM2를 이용한 증분식 최적화는 실시간으로 목표 상태와 공분산을 업데이트하며, 전체 그래프의 MAP 해를 Gaussian 근사로 표현한다. 이렇게 얻어진 공분산 Σ_T,k는 위치 블록 Σ_p,T,k 를 추출해 χ² 분포 기반의 신뢰 반경 R_k 를 계산하는 데 사용된다.

제어 설계는 CLF와 CBF를 결합한 형태이며, 여기서 CLF는 목표와의 거리 d_k 를 원하는 스탠드오프 거리 d* 로 수렴시키는 역할을, CBF는 물리적 거리 제한과 안전 마진을 보장한다. 핵심은 R_k 로부터 유도된 ‘confidence‑tube’ deadzone을 도입해, 추정 불확실성이 큰 구간에서는 제어 입력을 완화하고, 반대로 확신이 높은 구간에서는 더 공격적인 추적을 허용한다는 점이다. 이는 기존의 고정 마진 방식보다 안전성을 크게 향상시키면서도 추적 정확도를 유지한다.

시뮬레이션에서는 측정 노이즈와 이상치 비율을 변동시켜도 제어기가 거리 오차와 안전 위반을 최소화함을 보였으며, 실제 실내 복도 실험에서는 UAV가 목표와의 거리 1.5 m 를 유지하면서도 급격한 장애물(문) 발생 시 자동으로 회피하고, 추정 공분산이 급증하면 거리 제한을 넓혀 충돌을 방지한다. 전체 시스템은 저비용 단일 앵커 하드웨어만으로도 복잡한 실내 환경에서 신뢰성 있는 3D 추적이 가능함을 입증한다.