### 0.0.1 다중 센서 융합을 위한 공간적 오프셋(Spatial Offset) 정밀 캘리브레이션
드론의 덩치가 커지고 실장되는 하드웨어가 복잡해질수록, 각 센서들은 기체의 정중앙(Center of Gravity, CG)에서 멀찍이 떨어져서 장착될 수밖에 없다. GPS 안테나는 전자파 간섭(EMI)을 피하기 위해 꼬리 날개 끝이나 높은 마스트(Mast) 위로 밀려나고, IMU는 진동이 적은 동체 한가운데에, 카메라 짐벌은 기수 맨 앞단에 달리는 식이다.
이러한 공간적 분산(Spatial Dispersion) 은 다중 센서 융합 알고리즘(EKF2)에게 있어 치명적인 수학적 모순을 만들어낸다. 기체가 제자리에서 회전(Yaw)만 하더라도, CG에 위치한 IMU는 제자리걸음을 시사하지만, 꼬리에 달린 GPS 안테나는 커다란 원을 그리며 초당 몇 미터씩 ’이동’하고 있다고 보고하기 때문이다.
본 절에서는 이 모순을 해결하기 위한 필수 관문인 공간적 오프셋(Spatial Offset), 즉 레버암(Lever Arm)의 정밀 캘리브레이션 기법과 그 수학적 당위성에 대해 다룬다.
0.1 레버암(Lever Arm) 효과와 센서 이질성의 충돌
서로 다른 위치에 장착된 센서들이 관측하는 기체의 운동 상태(동역학)는 결코 같을 수 없다. 이를 고전 역학에서는 점 운동학(Point Kinematics) 의 차이로 설명한다.
- 회전 시의 선속도 발생: 기체가 각속도 \vec{\omega} 로 회전할 때, 무게 중심(CG)에서 벡터 \vec{r} 만큼 떨어진 센서(예: GPS)가 느끼는 선속도 \vec{v}_{sensor} 는 기체 본연의 선속도 \vec{v}_{cg} 에 회전으로 인한 외적(Cross Product) 성분 \vec{\omega} \times \vec{r} 이 더해진 값으로 관측된다.
- 관측의 불일치(Innovation Spike): EKF2 필터는 IMU(가속도/자이로) 데이터를 바탕으로 “기체는 현재 정지 상태에서 제자리 회전만 하고 있다“고 예측(Prediction)한다. 그런데 1미터 뒤에 달린 GPS 센서가 “아니다, 우리는 지금 동쪽으로 3m/s의 속도로 날아가고 있다!“라고 관측(Observation) 데이터를 던진다.
- 공간적 오프셋(Lever Arm, \vec{r})이 파라미터로 입력되어 있지 않다면, EKF2는 이 불일치(Innovation)를 처리하지 못하고 혼란에 빠진다. 이는 곧장 GPS 타임아웃, 위치 추정치 발산(Divergence), 그리고 최악의 경우 기체의 미친 듯한 꿀렁거림(Toilet-bowling)으로 이어진다.
0.2 EKF2 레버암 파라미터의 구조적 이해
PX4는 이러한 공간적 오차를 상쇄(Compensation)하기 위해 차원별로 세밀한 오프셋 튜닝 변수들을 제공한다. 이 값들은 모두 기체의 무게 중심(CG, 또는 IMU 기준점) 을 원점 (0, 0, 0) 으로 하는 ’기체 고정 좌표계(Body Frame, FRD)’를 기준으로 미터(m) 단위로 입력된다.
기준 좌표계인 FRD(Forward, Right, Down) 규약에 따라 직관적인 부호(Sign) 설정이 매우 중요하다.
EKF2_GPS_POS_X(전/후방): GPS 안테나가 무게 중심보다 기수(앞) 쪽에 있으면 양수(+), 꼬리(뒤) 쪽에 있으면 음수(-)로 미터 잣대로 실측하여 기입한다.EKF2_GPS_POS_Y(좌/우측): GPS 안테나가 무게 중심보다 우측 날개 쪽에 치우쳐 있으면 양수(+), 좌측이면 음수(-)다.EKF2_IMU_POS_X, Y, Z: 만약 사용자가 보드(FC) 자체를 CG에서 멀리 떨어진 엉뚱한 곳에 장착했다면, EKF2의 모든 기준점이 되는 IMU의 오프셋마저도 역으로 보정해 주어야 한다.
0.3 정밀 측정을 위한 캘리브레이션 팁
가장 흔히 저지르는 실수는 GPS 안테나의 레버암을 눈대중으로 대충 입력하거나 아예 0으로 방치하는 것이다. 250급 레이싱 드론에서는 큰 문제가 안 되지만, 양축 간격이 1미터가 넘어가는 대형 산업용 드론에서는 10cm의 오차가 치명타가 될 수 있다.
- 위상 중심(Phase Center) 기준: 안테나의 둥근 플라스틱 껍데기가 아니라, 그 내부에서 실제 전파망이 교란파를 수신하는 중심점(위상 중심)을 기준으로 줄자를 가져다 대야 한다. (보통 제조사 데이터시트에서 높이를 명시한다).
EKF2_GPS_POS_Z의 착각: FRD 좌표계에서 아래(Down) 방향이 양수(+)다! GPS 안테나를 마스트(폴대)를 세워 높은 곳에 장착했다면, Z축 편차는 음수(Negative) 값을 입력해야 한다. (예: 20cm 위로 올렸다면-0.20입력). 이를 실수하여 양수+0.20으로 넣으면 EKF2는 안테나가 땅바닥을 긁고 돌아다닌다고 착각하여 걷잡을 수 없는 제어 루프 진동을 일으킨다.
정교하게 측정된 공간적 오프셋 파라미터 한 줄은, 수백 줄의 노이즈 필터링 코드보다 훨씬 확실하게 다중 센서 간의 평화로운 공존(Fusion)을 보장하는 기초 공사다.