기술 요약: 쿼드로터 UAV 궤적 추적을 위한 오차 상태(Error-State) LQR 정식화

문제 정의

쿼드로터 무인 항공기(UAV)의 제어는 본질적인 비선형 동역학, 저구동성(underactuation), 그리고 동적인 환경 내에서의 정밀한 궤적 추적 요구사항으로 인해 복잡합니다. 전통적인 제어 방법들은 이러한 비선형성을 효율적으로 처리하는 것과 실시간 애플리케이션에 필요한 계산 용이성을 유지하는 것 사이에서 종종 절충안(trade-off)에 직면합니다. 구체적으로, 오일러 각(Euler angles)과 같은 표준 매개변수화를 사용하여 자세 오차를 표현하면 특이점(singularities) 문제가 발생하며, 전체 비선파 동역학을 직접 제어하는 것은 고주파 피드백 루프를 위해 계산 비용이 너무 높을 수 있습니다.

방법론

본 논문은 계층적(cascaded) 제어 구조와 특정 수학적 오차 표현을 통해 이러한 과제들을 해결하기 위해 설계된 오차 상태 선형 이차 조절기(Error-State LQR) 정식화를 제안합니다.

1. 오차 상태 표현

방법론의 핵심은 명목 궤적(nominal trajectory)으로부터의 편차를 포착하는 오차 상태 벡터($\delta x$)의 정의입니다.

• 상태 정의: 전체 상태는 위치($p$), 속도($v$), 그리고 자세(단위 쿼터니언 $q$로 표현됨)를 포함합니다.
• 오차 정의: 오차 상태 $\delta x = [\delta p, \delta \theta, \delta v]^T$는 실제 상태에서 명목 상태를 차감하여 구성됩니다.
• 자세 처리: 결정적으로, 자세 오차는 쿼터니언 차이나 오일러 각으로 표현되지 않습니다. 대신, 지수 좌표(exponential coordinates)($\delta \theta$)를 활용하며, 여기서 회전 오차 행렬은 $\delta R = \exp([\delta \theta]_\times)$로 정의됩니다. 이는 특이점이 없는 압축된 자세 오차 표현을 제공합니다.

2. 시스템 동역학 및 선형화

논문은 단일 강체 가정과 집중 질량(lumped mass)을 기반으로 실제 상태, 명목 상태, 그리고 오차 상태에 대한 운동학 및 동역학을 유도합니다.

• 유도: 오차 상태의 시간 미분값($\dot{\delta p}, \dot{\delta v}, \dot{\delta \theta}$)이 유도됩니다. 이 유도는 소각 근사(small-angle approximations)를 채택하고 2차 항을 무시하여 실제 동역학과 명목 동역학 사이의 관계를 단순화합니다.
• 선형화: 비선형 오차 상태 동역학은 충분히 높은 주파수에서 현재 추적 오차를 기준으로 선형화됩니다. 이러한 반복적 재선형화(iterative re-linearization)를 통해 시스템은 $\dot{\delta x} \approx A\delta x + B\delta u$ 형태로 표현될 수 있으며, 여기서 $A$와 $B$는 오차 동역학에서 유도된 자코비안(Jacobian) 행렬입니다. 이 접근 방식은 선형화 지점을 지속적으로 업데이트함으로써 비선형 시스템에 선형 제어 이론을 적용할 수 있게 합니다.

3. 제어 구조

제어 전략은 다음과 같이 계층적 시스템으로 구현됩니다:

• 외곽 루프 (LQR): LQR 컨트롤러는 이차 비용 함수 $J = \int_0^\infty (\delta x^T Q \delta x + \delta u^T R \delta u) dt$를 최소화하도록 설계됩니다. 컨트롤러는 대수 리카티 방정식(Algebraic Riccati Equation)을 통해 피드백 이득 행렬 $K$를 계산하여 교정 제어 입력 $\delta u = -K\delta x$를 생성합니다. 전체 제어 입력은 $u_t = u - K\delta x$가 됩니다.
• 내부 루프 (Bodyrate 컨트롤러): LQR은 원하는 각속도를 가상 제어 입력으로 취급합니다. 원하는 각속도를 추적하기 위해 계층적 바디레이트(bodyrate) 컨트롤러가 사용됩니다. 이 내부 루프는 관성 텐서 $J$와 원하는 각속도 및 실제 각속도의 차이를 기반으로 필요한 토크 $\tau$를 계산하는 피드백 선형화(feedback linearization)를 포함하는 P(Proportional) 컨트롤러를 사용합니다.

주요 기여

• 특이점이 없는 자세 오차: 오일러 각과 관련된 특이점을 피하기 위해 지수 좌표를 사용하여 자세 오차를 표현하는 방법을 입증했습니다.
• 반복적 재선형화: 오차 상태 동역학을 현재 오차를 기준으로 선형화하여, LQR 컨트롤러가 실시간으로 비선형 쿼드로터 동역학에서 효과적으로 작동할 수 있음을 보여주는 상세한 유도를 제공합니다.
• 계층적 제어 통합: 가상 각속도 명령에서 물리적 액추에이터 토크로의 매핑을 명시적으로 처리하며 LQR 궤적 추적기와 바디레이트 컨트롤러를 통합했습니다.
• 포괄적 유도: 오차 상태 운동학, 선형화 과정, 그리고 LQR 정식화에 필요한 자코비안 행렬($A$ 및 $B$)의 구축에 대한 완전한 수학적 유도를 제공합니다.

결과

논문은 제안된 컨트롤러의 성능을 입증하는 시뮬레이션 결과를 제시합니다.

• 궤적 추적: 컨트롤러가 레므니스케이트(lemniscate, 8자 모양) 궤적을 성공적으로 추적함을 보여줍니다.
• Yaw 추적: 시스템이 궤적을 따라 요(yaw) 각도를 효과적으로 추적합니다.
• 초기 조건: 결과에서는 궤적 시작 시의 추적 오차가 UAV가 평평한 초기 자세($q_0 = (1, 0, 0, 0)^T$)에서 시작했기 때문이며, 컨트롤러가 이후 이를 수정함을 언급합니다.

의의 및 주장

본 논문은 이 오차 상태 LQR 정식화가 쿼드로터 궤적 추적을 위한 견고하고 계산 효율적인 솔루션을 제공한다고 주장합니다. 지수 좌표와 반복적 선형화를 활용함으로써 이 방법은 다음을 달 성합니다:

1. 정밀도 및 안정성: 동적인 환경에서 위치, 속도 및 자세 오차를 zero로 몰아넣을 수 있는 능력.
2. 실시간 적용 가능성: 선형 시스템 표현을 통해 매 단계마다 전체 비선형 최적 제어 문제를 푸는 계산적 부담 없이 고주파 제어 업데이트를 가능하게 합니다.
3. 강건성: 이 접근 방식은 전체 비선형 동역학을 직접 제어하기보다 명목 궤적으로부터의 편차를 최소화하는 데 집중함으로써 쿼드로터의 비선형성을 처리합니다.

본 연구는 고전적인 선형 제어 이론(LQR)과 복잡한 비선형 현실(UAV 비행) 사이의 간극을 메우며, 정밀한 쿼드로터 제어를 위한 실용적인 프레임워크로서 자리매김하고 있습니다.