13.3.1.1. Survey-in 모드의 3D 절대 좌표 수렴 수학적 모델
무인 항공기(UAS)의 지상 관제국에 설치되는 로컬 베이스 스테이션(Base Station)은, 전원이 켜짐과 동시에 자신의 정확한 지구 상의 위치(위도, 경도, 고도)를 파악해야 하는 중대한 임무(Survey-in)를 부여받는다. Survey-in 모드는 삼각대를 세운 현재 기하학적 원점을 알지 못하는 상태에서, 하늘에서 떨어지는 GPS 의사 거리(Pseudorange) 관측치들을 수 분 동안 누적하여 통계적으로 신뢰할 수 있는 단일 3D 좌표계를 도출해 내는 과정이다.
본 절에서는 u-blox ZED-F9P와 같은 하이엔드 수신기가 Survey-in 모드에서 어떻게 초기의 거친 위치 데이터를 수렴(Convergence)시켜 나가는지 그 기저의 수학적 모델 메커니즘을 분석한다.
1. 노이즈 관측치의 선형 필터링과 평균(Accumulated Mean) 방정식
베이스 모듈 안테나가 고도각 10^\circ 이상의 위성 20여 개를 포착하기 시작하면, 모듈은 매 1\text{초}(1\text{Hz})마다 수십 미터의 공간 오차를 포함한 원시 위치 좌표 (x_i, y_i, z_i) 를 산출해 낸다. Survey-in의 첫 번째 임무는 이 노이즈 낀 시계열 데이터를 평활화(Smoothing)하는 것이다.
가장 단순하면서도 강력한 수렴 모델은 **이동 평균(Moving Average)**과 누적 평균(Cumulative Mean) 알고리즘이다.
시간 t = n (초) 시점에서의 고도 누적 평균 \bar{z}_n 은 다음 점화식으로 계산된다.
\bar{z}_n = \frac{(n-1) \cdot \bar{z}_{n-1} + z_n}{n}
- 여기서 z_n 은 현재 초에 들어온 노이즈가 낀 고도 관측치이다.
- 이 점화식은 마이크로컨트롤러(MCU)가 무한히 많은 과거의 배이스밴드 측정 데이터를 메모리 버퍼에 저장할 필요 없이, 오직 직전 평균값 \bar{z}_{n-1} 과 누적 카운트 n 만을 사용하여 실시간으로 평균 중심점(Centroid)을 갱신하게 해준다.
- 평면 좌표인 위도(x)와 경도(y) 또한 동일한 수학적 기법으로 매초 수렴해 들어간다.
2. 3D 정밀도 (Standard Deviation / Accuracy) 수렴 모델
단순히 좌표의 평균 지점을 구하는 것만으로는 “현재 산출된 위치를 얼마나 신뢰할 수 있는지“를 알 수 없다. 베이스 스테이션이 Survey-in을 종료하고 RTCM 보정 데이터를 내뿜기(Fixed Mode 전환) 위한 가장 절대적인 문지기(Gatekeeper)는 3D 위치 표준편차(Standard Deviation) 임계값이다.
2.1 측정 오차의 공분산 행렬 (Covariance Matrix)
측정치는 3차원 공간(X, Y, Z)에 분포하므로, 단순히 스칼라 분산이 아닌 3 \times 3 차원의 공분산 행렬 \Sigma 를 실시간으로 갱신해야 한다.
스칼라 분산 \sigma^2 의 재귀적 연산(Welford’s Algorithm)은 다음과 같이 정의된다.
S_n = S_{n-1} + (x_n - \bar{x}_{n-1})(x_n - \bar{x}_n)
\sigma_n^2 = \frac{S_n}{n}
베이스 스테이션 수신 필터는 동(East), 북(North), 상(Up) 세 방향에 대한 각각의 분산 diag(\Sigma) 을 구하고, 이를 종합하여 3차원 복합 측정 정밀도(Mean 3D Accuracy) 벡터 크기를 산출한다.
Accuracy_{3D} = \sqrt{\sigma_{East}^2 + \sigma_{North}^2 + \sigma_{Up}^2}
이 Accuracy_{3D} 값이 QGroundControl의 화면에서 소위 Mean Accuracy로 번역되어 조종사에게 표시되는 핵심 지표이다.
2.2 임계값(Threshold) 조건의 결속 (AND Logic)
Survey-in 알고리즘이 성공 판정을 내리기 위해서는 두 개의 불리언(Boolean) 부등식이 동시에 True 를 반환해야 한다.
- 최소 관측 시간(Minimum Observation Time): n > T_{min} (예: T_{min} = 60\text{초})
위성 배열 결함(PDOP Spike) 오류 등 일시적인 수렴 착각을 방지하기 위해 강제하는 절대적 시간 제약이다. - 3D 정밀도 한계(3D Accuracy Limit): Accuracy_{3D} < Acc_{limit} (예: Acc_{limit} = 2.0\text{ m})
계산된 공간 표준편차 구체의 반지름이 지정된 임계 반경 이내로 완전히 찌그러졌음(Shrinked)을 수학적으로 증명하는 조건이다.
3. 다중경로(Multipath)와 수렴 지연의 수학적 발산
안테나 제조사 매뉴얼을 보면 “개활지에서 2분 내 수렴” 이라 적혀있으나, 실제 현장(예: 빌딩 숲 옥상, 철책선 근처)에서는 30분이 지나도록 Accuracy 수치가 3\text{ m} 언저리에서 더 이상 내려가지 않고 발산(Divergence)하는 현상을 자주 겪는다.
이것은 통계학의 정상성(Stationarity) 가정이 깨졌기 때문이다.
- 앞선 누적 평균/분산 알고리즘은 오차 노이즈가 중심이 ‘0’ 인 가우시안 정규 분포(Gaussian White Noise)를 따른다는 가정하에 수렴을 보장한다.
- 그러나 주변 벽면을 맞고 튀어 칩셋으로 빨려 들어온 다중경로(Multipath) 신호는 한쪽 방향으로 치우친(Biased), 즉 평균이 0 이 아닌 거대한 벡터 오차를 가진다.
- 결과적으로 z_n 값에 상수항 오차가 계속 끼어들어 오므로, 점화식의 분산 값 \sigma_n^2 이 찌그러지지 않고 특정 크기(예: 3\text{ m}) 한계에 갇혀 진동(Oscillation)하게 된다.
결론적으로 Survey-in 프로세스는 단순한 딜레이 대기 로직이 아니다. 우주의 거대 궤도 기하학과 지구 지표면의 전자기적 반사율이 만들어내는 광범위한 확률적 오차 덩어리를, 한 점의 3D 텐서(Tensor) 행렬로 압착시켜 나가는 베이스 스테이션 최전선의 수학적 필터링 제련 과정이다. 여기서 산출된 \bar{x}, \bar{y}, \bar{z} 절대 교차점 좌표는 PX4 기체가 비행하는 모든 로컬 프레임(Local Frame)의 진리의 영점(0, 0, 0)이 된다.