### 0.0.1 GPS 속도(Velocity) 데이터 중심의 초기 정렬(Initial Alignment) 및 자이로 바이어스(Gyro Bias) 수렴 과정

### 0.0.1 GPS 속도(Velocity) 데이터 중심의 초기 정렬(Initial Alignment) 및 자이로 바이어스(Gyro Bias) 수렴 과정

드론이 배터리를 연결하고 지면에 얌전히 놓여 있는 부팅 직후의 순간을 상상해 보자. 센서 융합 모듈(EKF2) 내부의 수학적 상태(State)는 아직 기체가 어느 방향(Heading)을 바라보고 있는지, IMU가 어느 정도의 태생적 불량(Bias)을 갖고 있는지 전혀 알지 못하는 백지상태다.
PX4-Autopilot이 기체를 하늘로 띄우기 전 반드시 완수해야 하는 이 영점 조절 과정을 **초기 정렬(Initial Alignment)**이라 부르며, 이 과정에서 GPS가 제공하는 ‘속도(Velocity)’ 관측치가 방아쇠(Trigger) 역할을 수행한다.

0.1 나침반(Compass) 가관측성(Observability)의 한계와 GPS Course-over-ground

지면에 가만히 정지해 있을 때(정적 상태), 드론이 자신의 진북(True North) 방향을 알아낼 유일한 단서는 지자기 센서(Magnetometer)뿐이다. 하지만 현대의 드론은 모터의 거대한 자력, 고전류 배터리 케이블의 전자기장(EMI), 심지어 바닥의 철근 콘크리트로 인해 나침반 데이터가 심각하게 왜곡되어 있다.
EKF2는 이 오염된 나침반 방위를 100% 신뢰하지 않은 채로 조심스럽게(불확실성 공분산을 높게 잡고) 임시 요(Yaw) 각도를 설정해 둔다.

  • 드론이 마침내 이륙하여 직선 비행(Kinematic Movement)을 시작하면, GPS 안테나는 도플러 효과(Doppler Effect)를 통해 매우 정밀한 3차원 속도 벡터(vel_n_m_s, vel_e_m_s)를 획득한다.
  • 이 두 속도 벡터의 아크탄젠트(Arctangent)를 구하면 기체가 실제로 대지 위를 날아가고 있는 절대 방위, 즉 Course-over-ground (COG) 가 산출된다.
  • EKF2는 이 순간 무릎을 치며, 찌그러진 나침반 방위 대신 GPS 속도 벡터가 제시하는 절대 궤적 정보를 채택하여 기체의 요(Yaw) 정렬(Alignment)을 단숨에 확정 짓는다. 이것이 ’동적 정렬(In-flight Alignment)’의 핵심이다.

0.2 가속도계 표류(Drift)와 자이로 바이어스(Gyro Bias)의 수렴

MEMS 기반의 IMU 센서는 태생적으로 온도 변화와 미세한 구조적 비대칭성 때문에 가만히 놔두어도 값이 흐르는 바이어스(Bias) 현상을 겪는다. 특히 자이로스코프의 바이어스가 누적되면, EKF2는 기체가 가만히 있는데도 공중에서 서서히 뒤집어지고 있다고(Roll/Pitch Drift) 착각하게 된다.

GPS의 속도 관측치는 이 치명적인 내부 붕괴를 막는 수학적 항체 역할을 한다.

  1. 예측 모델의 전개: EKF2는 자이로의 각속도를 적분하여 자세(Attitude)를 구하고, 이 자세 행렬을 통해 중력 벡터를 회전시킨 뒤 가속도계 데이터에서 중력을 빼서 순수 비행 가속도를 얻어낸다. 이를 다시 적분하면 ’EKF2가 스스로 예상한 기체 속도’가 나온다.
  2. 모순의 발견: 만약 자이로스코프에 미세한 바이어스(오류)가 끼어 있다면, 계산된 중력 벡터가 비뚤어져 잘못된 가속도를 산출하게 되고, 최종적으로 ’예상 속도’가 터무니없는 방향으로 계속 커지게 된다.
  3. GPS 속도에 의한 교정(Correction): 이때 GPS로부터 “실제 우리 속도는 V_{true} 야!“라는 강건한 수치(관측치)가 들어온다.
  4. 역추적 연쇄(Back-propagation of Innovation): EKF2 알고리즘은 ’예상 속도’와 ‘GPS 실제 속도’ 사이의 오차(Innovation)를 감지하고, 이 오르막길을 역으로 거슬러 올라가(칼만 필터의 상태 공분산 행렬 연산) 오차의 진범이 자이로스코프의 Z축 바이어스 였음을 수학적으로 도출해 낸다.

0.3 In-air Alignment 완료와 EKF 상태 플래그 활성화

GPS 속도 지속 관측을 통해 자이로 바이어스 추정치가 더 이상 흔들리지 않고 특정 상수로 수렴(Convergence)하게 되면, EKF2는 마침내 자신의 상태 벡터(State Vector)가 현실 세계와 완벽히 동기화되었음을 선언한다.

  • 이 시점이 되면, PX4 커맨더(Commander) 모듈로 local_position_valid = true 와 global_position_valid = true 플래그가 전파된다.
  • 조종사의 GCS(QGroundControl) 화면에 비로소 녹색으로 “Ready to Fly” (Position mode available) 메시지가 점등되는 것은, 바로 이 심층부의 자이로 바이어스 수렴 수학이 완전히 종료되었음을 알리는 위대한 신호탄이다.