13.4.1.2. `EKF2_GPS_CTRL` 비트 연산 소스코드(`src/modules/ekf2/ekf2_params.c`) 분석

PX4-Autopilot의 심장부인 EKF2 (Extended Kalman Filter 2)는 멀티센서 융합을 위한 거대한 수학적 상태 머신(State Machine)이다. 수많은 센서 데이터 중, 칼만 필터가 GPS 데이터를 어떻게 ’취사선택’할 것인지를 지시하는 가장 강력무도한 파라미터가 바로 EKF2_GPS_CTRL 이다.

본 절에서는 단순한 파라미터 설정법을 넘어서, C++ 펌웨어 소스 코드 내부(src/modules/ekf2/ekf2_params.c 등 EKF2 모듈 계층)에서 이 파라미터의 비트마스크(Bitmask)가 어떻게 파싱(Parsing)되고, 각 비트 플래그가 칼만 필터 내부의 측정 업데이트(Measurement Update) 로직을 어떻게 분기(Branching)시키는지 심층 분석한다.

1. `EKF2_GPS_CTRL` 파라미터의 자료 구조와 비트마스크(Bitmask) 매크로 정의

PX4 펌웨어 내에서 모든 파라미터는 PARAM_DEFINE_ 매크로를 통해 시스템 전역에 등록된다. ekf2_params.c (최신 체계에서는 .cpp 또는 모듈별 params.yaml 로 이관되는 추세이나 기본 아키텍처는 동일함) 내부를 살펴보면, EKF2_GPS_CTRL 은 32비트 정수형(INT32)으로 선언되어 있다.

C++ 코드 상에서 EKF 객체는 이 값을 읽어들인 후, 다음과 같은 비트 시프트(Bit-shift) 매크로 상수들과 비트단위 논리곱(AND, &) 연산을 수행하여 어떤 기능이 켜져 있는지 판별한다.

// EKF2 GPS 제어 비트마스크 매크로 정의 예시 (유사 코드)
#define MASK_USE_GPS_POS  (1 << 0)  // Bit 0: Value 1
#define MASK_USE_GPS_VEL  (1 << 1)  // Bit 1: Value 2
#define MASK_USE_GPS_HDG  (1 << 2)  // Bit 2: Value 4
#define MASK_USE_GPS_YAW  (1 << 3)  // Bit 3: Value 8
#define MASK_USE_GPS_BLND (1 << 4)  // Bit 4: Value 16 (Dual GPS Blending)

이 기법의 가장 큰 수학적 이점은 하나의 int32 변수 안에 무려 32개의 독립적인 Toggle 스위치를 메모리 낭비 없이 쑤셔 넣을 수 있으며, if 문에서의 연산 주기가 CPU 클럭 1사이클에 불과할 정도로 극히 빠르다는 것이다.

2. 비트 파싱과 필터 융합(Fusion) 제어 분기 로직

EKF2의 메인 루틴(Ekf::update())이 돌 때마다, sensor_gps 토픽 수신 버퍼에 새로운 GPS 관측치가 도착했는지 확인한다. 데이터가 유효(Valid)하다고 판단되면, EKF2 코어 방정식은 EKF2_GPS_CTRL 파라미터 값을 변수에 캐싱(Caching)해 두고 각 비트 플래그를 검사하기 시작한다.

2.1 Bit 0 (`MASK_USE_GPS_POS`) 파싱: 3D 위치 융합

가장 근원적인 위치 추정 비트이다.

if (gps_ctrl_param & MASK_USE_GPS_POS) {
    // 1. 관측 벡터(z) 설정: 수신된 GPS 위성도 좌표 (Lat, Lon, Alt를 NED로 변환)
    // 2. 측정 행렬(H) 매핑
    // 3. 혁신(Innovation) 도출 및 칼만 이득(K) 계산
    fuseGpsPos(); 
}

만약 이 비트가 꺼져 있다면(Value가 짝수인 경우), 기체는 아무리 GPS에 Fixed RTK가 떴다 한들 좌표 축적을 전면 거부하고 관성 항법(IMU)과 기압계에만 의존하게 된다. 통상적으로 실내(Indoor) VIO 센서에 의존할 때 고의로 이 비트를 끄곤 한다.

2.2 Bit 1 (`MASK_USE_GPS_VEL`) 파싱: 반송파 도플러 속도 융합

위치만큼이나 비행 동역학 제어에 치명적인 요소는 ‘속도(Velocity)’ 이다.

if (gps_ctrl_param & MASK_USE_GPS_VEL) {
    fuseGpsVel();
}

일반 GPS 칩셋이 오로지 위치 전위( $\Delta x / \Delta t$ )로 속도를 추정하는 반면, 고성능 모듈은 반송파의 도플러 편이(Doppler Shift) 효과를 역추적하여 오차 $0.05\text{ m/s}$ 이내의 환상적인 3D 속도 벡터를 뽑아낸다.
이 비트가 True 로 평가되어 fuseGpsVel() 함수가 호출되면, 필터는 돌풍이나 관성에 의해 기체가 선형 가속(Slip)되는 현상을 칼같이 잘라내어(Cut-off) 완벽한 호버링 착좌감을 제공한다.

2.3 Bit 3 (`MASK_USE_GPS_YAW`) 파싱: 이동 베이스 요(Yaw) 융합

듀얼 안테나(Moving Base/Rover) 시스템을 탑재했을 때 활성화하는 비트이다.

if (gps_ctrl_param & MASK_USE_GPS_YAW) {
    // 지자기 센서 대신 두 GPS 안테나 간의 베이스라인 벡터를 이용해 요(Yaw) 각도를 합성
    fuseGpsYaw();
}

이 로직 블록이 발동하면, 코어는 sensor_gps 메시지 안에 들어있는 heading 필드(GPS가 스스로 연산하여 넘겨준 안테나 간 측각 데이터)를 가져다가 기체의 전역 방위각 추정에 곧장 꽂아 넣는다.
주의: 단일(Single) GPS 시스템에서 사용자가 이 비트를 실수로 켜면(Value: 15), 코드 흐름은 fuseGpsYaw() 에 진입하려 하나 들어오는 값이 Null 이거나 허구의 값이므로 EKF2 상태 트리가 즉각 발산(Divergence)하여 비행 불능 상태에 빠진다.

3. 실무적 의의 및 C++ 관점에서의 시스템 안정성 방어

결론적으로 EKF2_GPS_CTRL 은 단순한 온-오프 스위치가 아니라, 칼만 필터의 거대한 선형 대수 행렬(Linear Algebra Matrices, $H, R, K$ ) 구성을 동적으로 확장/축소하는 런타임 아키텍처 스위치(Runtime Architecture Switch) 이다.

PX4 개발진이 수많은 센서 사용 여부를 굳이 bool use_gps_vel, bool use_gps_pos 와 같이 수십 개의 개별 파라미터로 쪼개지 않고 단일 int32 비트마스크 변수에 몰아넣은 이유는 세 가지다.

메모리 절약과 접근 속도: uORB 버스 및 파라미터 메모리 조회 연산을 단 한 번으로 단축.
원자적(Atomic) 업데이트 보장: 사용자가 튜닝 시 위치와 속도를 동시에 켜고 끌 때, 파라미터가 분리되어 있으면 메모리 레이스 컨디션(Race Condition)에 의해 시스템이 한 틱(Tick) 동안 비논리적인 상태에 빠질 수 있다. 단일 정수형 기반의 비트 세팅은 완벽한 동기화를 보장한다.
가독성과 확장성 강화: 향후 새로운 융합 기법이 논문에 발표되면, 개발자는 새로운 비트 플래그 매크로 하나를 정의하고 if (gps_ctrl_param & NEW_MASK) 한 줄만 추가하면 된다.

이처럼 C++와 임베디드 코딩의 철학이 통계적 추론 알고리즘과 만나는 우아한 교차점이 바로 EKF2_GPS_CTRL 비트 연산 소스 코드의 진면목이라 하겠다.

13.4.1.2. EKF2_GPS_CTRL 비트 연산 소스코드(src/modules/ekf2/ekf2_params.c) 분석

1. EKF2_GPS_CTRL 파라미터의 자료 구조와 비트마스크(Bitmask) 매크로 정의