29.4.1.3. 3차원 회전 변환: 오일러 각 객체 생성 후 쿼터니언(Quaternion) 대수계로의 캐스팅 연산자 오버로딩 소스 분석

29.4.1.3. 3차원 회전 변환: 오일러 각 객체 생성 후 쿼터니언(Quaternion) 대수계로의 캐스팅 연산자 오버로딩 소스 분석

1. 오일러 각(Euler Angle)의 한계와 쿼터니언(Quaternion)의 도입 배경

매뉴얼 비행 제어 파이프라인에서 조종기의 스틱 입력값을 기반으로 롤(Roll), 피치(Pitch), 요(Yaw)의 각도(\phi, \theta, \psi)를 산출하는 과정은 인간의 시각에서 매우 직관적이다. 그러나 비행 제어기(Flight Controller)의 코어 루프인 mc_att_control (멀티콥터 자세 제어기)로 이 목표값들을 전달하기 위해서는 직교 좌표계 회전의 근본적인 수학적 한계인 짐벌 락(Gimbal Lock) 현상을 극복해야 한다. 짐벌 락은 두 개의 회전축이 일치하여 자유도(Degree of Freedom) 하나를 상실하는 현상으로, 기체가 극한의 자세(-90도 피치 수직 강하 등)에 도달했을 때 제어 불능 상태를 유발할 수 있다.

이를 근원적으로 해결하기 위해 PX4-Autopilot v1.14는 모든 3차원 회전 및 자세 변환을 4원수 대수계인 쿼터니언(Quaternion, q = q_0 + q_1i + q_2j + q_3k) 기반으로 처리한다. FlightTaskManualPosition 모듈은 내부적으로 계산된 오일러 각 목표치를 최종 uORB 메시지인 vehicle_attitude_setpoint로 퍼블리싱(Publishing)하기 직전, 최적화된 내부 수학 라이브러리를 통해 쿼터니언 타입 계스로 형 변환 혹은 캐스팅(Casting)을 이중으로 수행한다.

2. 차원 회전 변환 체계 및 연산자 오버로딩(Operator Overloading) 소스 분석

PX4의 기반 수학 라이브러리인 src/lib/matrix는 고도로 최적화된 C++ 템플릿 기법과 연산자 오버로딩(Operator Overloading) 설계 패턴을 적극 지원한다. 조종 입력이 쿼터니언 제어 신호로 역치환되는 과정을 코드 프로세스 레벨에서 분해하여 살펴보면 다음과 같다.

#include <matrix/math.hpp>

// 1. 산출된 Roll, Pitch, Yaw(라디안) 값을 바탕으로 오일러 각(Euler) 객체 초기화
// 내부적으로 배열 할당을 거쳐 matrix::Eulerf 구조체가 호출된다.
matrix::Eulerf euler_sp(roll_setpoint, pitch_setpoint, yaw_setpoint);

// 2. 쿼터니언(Quaternion) 객체로의 캐스팅 연산 및 변환
// 생성자 및 대입 연산자 오버로딩을 통해 자동으로 회전 행렬 기반의 4원수 동치 산출
matrix::Quatf q_sp(euler_sp);

// 3. uORB 메시지(vehicle_attitude_setpoint) 배열에 데이터 적재
_vehicle_attitude_setpoint_pub.q_d[0] = q_sp(0); // w (무차원 스칼라부)
_vehicle_attitude_setpoint_pub.q_d[1] = q_sp(1); // x (벡터부 i)
_vehicle_attitude_setpoint_pub.q_d[2] = q_sp(2); // y (벡터부 j)
_vehicle_attitude_setpoint_pub.q_d[3] = q_sp(3); // z (벡터부 k)

위 코드에서 아키텍처 구조적으로 가장 흥미로운 지점은 matrix::Quatf q_sp(euler_sp); 치환 구문이다. matrix 템플릿 라이브러리의 Quatf 클래스는 파라미터로 Eulerf 타입 객체가 들어올 경우, 내부적으로 오일러 각을 회전 행렬(Rotation Matrix) 동치 시스템 혹은 Z-Y-X 삼각함수 누적 연산으로 풀어내어 단위 쿼터니언 계수를 동적으로 산출하는 캐스팅 생성자(Casting Constructor) 를 동작시킨다.

이와 같은 다형성 템플릿 설계는 C++의 객체 지향 패러다임(Object-oriented Paradigm)을 극한으로 활용하여 제어 코드의 가독성을 폭발적으로 향상시킨다. ArduPilot 아키텍처의 오래된 C 스타일 매크로나 다중 파라미터 함수형 호출에 비해 PX4가 유지보수성 및 코드 직관성 영역에서 상대적 우위를 점하는 핵심 아키텍처 중 하나이다.

2.1 오일러-쿼터니언 변환 삼각함수 파이프라인 방정식

내부 캐스팅 연산자에 하드코딩된 수학 피연산 구조는 다음 수학적 대수 해석 방정식을 준수한다.
q_0 = \cos(\frac{\phi}{2})\cos(\frac{\theta}{2})\cos(\frac{\psi}{2}) + \sin(\frac{\phi}{2})\sin(\frac{\theta}{2})\sin(\frac{\psi}{2})
q_1 = \sin(\frac{\phi}{2})\cos(\frac{\theta}{2})\cos(\frac{\psi}{2}) - \cos(\frac{\phi}{2})\sin(\frac{\theta}{2})\sin(\frac{\psi}{2})

이러한 삼각함수 누적 연산 시, 변수의 절댓값 \vert \theta \vert 등에 의해 사분면 부호가 내부적으로 철저히 관리되며, L2 Norm에 기반한 정규화(Normalization) 과정이 포함되어 q_0^2 + q_1^2 + q_2^2 + q_3^2 = 1 공식을 항상 만족시키는 고신뢰성 단위 쿼터니언(Unit Quaternion)이 보장된다.

3. 데이터 캐스팅 및 uORB 퍼블리싱 아키텍처 다이어그램

입력된 목표 오일러 각 제어값이 템플릿 클래스를 거쳐 최종적으로 자세 제어기(Attitude Controller)에 인가되기까지의 형 변환 및 전송 다이어그램 흐름은 다음과 같이 도식화 될 수 있다.

classDiagram
    class FlightTaskManualPosition {
        +float roll_sp
        +float pitch_sp
        +float yaw_sp
        +generateAttitudeSetpoint()
    }
    class Eulerf {
        +float phi
        +float theta
        +float psi
        +Eulerf(phi, theta, psi)
    }
    class Quatf {
        +float[4] q
        +Quatf(Eulerf) <<Constructor Overload>>
    }
    class uORB_vehicle_attitude_setpoint {
        +float[4] q_d
        +publish()
    }
    class AttitudeControl {
        +update()
    }

    FlightTaskManualPosition ..> Eulerf : Instantiates
    Eulerf ..> Quatf : Direct Cast via Overloaded Constructor
    Quatf --|> uORB_vehicle_attitude_setpoint : Copy internal array data
    uORB_vehicle_attitude_setpoint --> AttitudeControl : Topic Subscription

이와 같은 일원화된 3차원 회전 변환 데이터 아키텍처는 매뉴얼 안정화 비행 뿐만 아니라 지상 관제 시스템(QGC v4.3) 기반의 복합 임무 비행(Mission Flight), ROS2 미들웨어 통신을 병행 활용한 오프보드(Offboard) 궤적 추종 등 모든 PX4 모듈에 물리 공간 좌표 변환을 위한 통일된 API 인터페이스를 제공한다. 제어 이론과 시스템 모델을 일체화시킨 본 객체 지향 변환 구조는 현대 오픈소스 비행 제어 시스템의 고도화된 소프트웨어 공학적 완성도를 선명하게 대변한다.

핵심 소스 참조 아카이브: PX4 수학 라이브러리 쿼터니언 정의부 src/lib/matrix/matrix/Quaternion.hpp