### 0.0.1 공분산 행렬(Covariance Matrix) 기반 기하학적 정밀도 저하율(DOP: Dilution of Precision) 산출 알고리즘 ($HDOP$, $VDOP$, $PDOP$)

### 0.0.1 공분산 행렬(Covariance Matrix) 기반 기하학적 정밀도 저하율(DOP: Dilution of Precision) 산출 알고리즘 (HDOP, VDOP, PDOP)

위성 항법 시스템(GNSS)의 최종적인 위치 오차는 수신기의 근본적인 측정 오차(UERE)뿐만 아니라, 하늘에 떠 있는 위성들의 기하학적 배치 상태에 의해 크게 증폭되거나 감소한다. 이러한 위성 기하학의 품질을 수학적으로 정량화한 무차원 지표가 바로 **기하학적 정밀도 저하율(DOP: Dilution of Precision)**이다.

PX4-Autopilot은 단순한 2D/3D 고정(Fix) 여부만을 판단하지 않고, 수신기가 전달하는 분해된 DOP 수치(HDOP, VDOP, PDOP 등)를 EKF2(Extended Kalman Filter)의 상태 공분산(State Covariance) 모델에 통합하여 수평/수직 제어 신뢰도를 동적으로 튜닝한다.

0.1 설계 행렬(Design Matrix)과 가중 공분산 행렬(Covariance Matrix)의 도출

수신기가 4개 이상의 위성으로부터 의사거리를 획득하여 위치를 산출할 때, 이는 테일러 급수(Taylor Series) 전개를 통한 선형화(Linearization) 과정을 거친다. 이때 각 위성을 향하는 시선 벡터(Line-of-Sight Vector)인 방향 여현(Direction Cosine)들로 이루어진 행렬을 **설계 행렬(Design Matrix, \mathbf{H})**이라고 한다.

\mathbf{H} 행렬의 각 행은 특정 위성 i를 향하는 x, y, z 방향의 단위 벡터 성분과 시간 오차 편미분항(보통 1)으로 구성된다. 위성 기하학이 위치 정밀도에 미치는 영향을 순수하게 분석하기 위해, 이 설계 행렬에 대한 정규 방정식(Normal Equation)의 역행렬을 도출하면 중량 계수 행렬(Weight Coefficient Matrix, \mathbf{Q}) 또는 공분산 행렬을 얻게 된다.

\mathbf{Q} = (\mathbf{H}^T \mathbf{H})^{-1}

이 4 \times 4 크기의 \mathbf{Q} 행렬은 주대각선(Main Diagonal) 요소들에 각각 X축(동서), Y축(남북), Z축(수직), 그리고 시간(Clock) 오차의 분산(Variance) 감소 비율을 내포하고 있다. ECEF(Earth-Centered, Earth-Fixed) 프레임을 로컬 NED(North-East-Down) 프레임으로 변환하여 생성된 \mathbf{Q} 행렬의 공간 성분은 다음과 같이 표현할 수 있다.

\mathbf{Q}_{NED} = \begin{bmatrix} q_{NN} & q_{NE} & q_{ND} & q_{Nt} \\ q_{EN} & q_{EE} & q_{ED} & q_{Et} \\ q_{DN} & q_{DE} & q_{DD} & q_{Dt} \\ q_{tN} & q_{tE} & q_{tD} & q_{tt} \end{bmatrix}

2. 하위 DOP 지표의 수학적 정의 (HDOP, VDOP, PDOP)

각 차원별 위치 오차의 배율(Multiplier)인 특징적인 DOP 지표들은 \mathbf{Q} 행렬의 주대각선 원소들에 의해 수학적으로 매우 간단하게 도출된다.

  • 위치 정밀도 저하율 (PDOP: Position DOP):
    3차원 공간(N, E, D) 전체의 기하학적 품질을 나타낸다. 낮을수록 위성들이 하늘의 넓은 영역에 고르게 분산(Spread)되어 있음을 의미한다.
    PDOP = \sqrt{q_{NN} + q_{EE} + q_{DD}}
  • 수평 정밀도 저하율 (HDOP: Horizontal DOP):
    위경도(2D 평면) 오차에 대한 척도이다. 드론의 자동 복귀(RTL/RTH) 모드나 웨이포인트 이동 시 가장 중요한 지표로 작용한다. PX4는 기본적으로 HDOP가 2.0 이하일 때만 자동 비행 진입을 허용하는 파라미터(COM_ARM_HDOP)를 갖는다.
    HDOP = \sqrt{q_{NN} + q_{EE}}
  • 수직 정밀도 저하율 (VDOP: Vertical DOP):
    수직(Altitude) 오차에 대한 척도이다. 지상의 수신기는 발밑(지구 반대편)의 위성을 볼 수 없으므로, 위성 배치가 상반구(Upper Hemisphere)로 제한되어 태생적으로 VDOP가 HDOP보다 크다(약 1.5배~2배).
    VDOP = \sqrt{q_{DD}}

0.2 PX4 내 적용 메커니즘과 비행 제어 영향성

PX4 아키텍처는 DOP 역학 구도를 비행 논리 상태 모델에 직접 연결한다.

예를 들어, 수신기가 협곡(Canyon)이나 도심 빌딩 숲에 진입하여 가시 위성들이 천정(Zenith) 근처 좁은 영역에만 밀집된다고 가정하자. 이 경우 위성 수는 8개 이상으로 충분하더라도 시선 벡터들의 선형 종속성(Linear Dependence)이 커져 \mathbf{H}^T \mathbf{H} 행렬이 특이 수치(Singular)에 가까워지고, 역행렬인 \mathbf{Q}의 대각 원소들이 급증하여 HDOP가 치솟는다.

PX4의 센서 유효성 감시기(Sensor Validity Checker)는 sensor_gps 토픽으로 유입되는 이 HDOP, VDOP 지표들을 상시 모니터링한다. DOP가 임계 파라미터를 초과하면, EKF2 필터는 해당 GPS 데이터의 가중치를 대폭 하향 조정하고, 관성 항법 장치(INS)와 기압계의 가중치를 상대적으로 끌어올려 위치 추정치 발산(Divergence)을 소프트웨어적으로 컷오프(Cut-off)한다. 이는 UERE 기반의 노이즈 분산(eph, epv) 처리와는 구별되는 별도의 기하학적 안전망(Geometric Failsafe) 체계이다.