10.73 쿼터니언 기반 드론 자세 안정화 제어

1. 자세 안정화의 목표

자세 안정화 제어(attitude stabilization control)는 드론이 외란에 의해 발생한 자세 편차를 신속하게 평형 자세로 복원하는 것을 목적으로 한다. 호버링 모드와 일반 비행 모드에서 모두 필수적이며, 안정화 성능이 비행체의 안전성과 임무 수행 능력을 직접 결정한다. 쿼터니언 기반 자세 안정화는 짐벌 락이 없고 모든 자세 영역에서 균등한 응답을 제공하며, 큰 각도의 편차에서도 안정적으로 동작한다는 장점이 있다.

2. 안정화 문제의 형식화

2.1 평형 자세

자세 안정화의 평형 자세는 일반적으로 수평 자세(피치 0, 롤 0)이며, 요 각도는 외부에서 지정된다. 평형 쿼터니언을 $\mathbf{q}_{\text{eq}}$ 라 하면, 안정화의 목표는 다음의 조건을 시간에 따라 만족시키는 것이다.

$\lim_{t \to \infty}\mathbf{q}(t) = \mathbf{q}_{\text{eq}}, \quad \lim_{t \to \infty}\boldsymbol{\omega}(t) = \mathbf{0}$

2.2 안정화의 도전 과제

자세 안정화는 다음과 같은 도전 과제를 가진다.

비선형 동역학: 회전 동역학은 본질적으로 비선형이며, 큰 자세 편차에서 선형화가 부정확해진다.
외란: 바람, 부하 변동, 모터 응답 비대칭 등 다양한 외란이 작용한다.
입력 포화: 모터의 추력과 회전 속도에 한계가 있어 제어 입력이 포화된다.
측정 잡음: IMU 측정값에 잡음이 포함되어 있다.
모형 불확실성: 관성 행렬과 모터 특성이 정확히 알려지지 않을 수 있다.

3. 자세 동역학 모형

3.1 강체 회전 동역학

드론의 회전 동역학은 본체 좌표계에서 다음과 같이 표현된다.

$\mathbf{J}\dot{\boldsymbol{\omega}} = -\boldsymbol{\omega} \times (\mathbf{J}\boldsymbol{\omega}) + \boldsymbol{\tau} + \boldsymbol{\tau}_d$

여기서

$\mathbf{J}$ : 본체 좌표계에서의 관성 행렬
$\boldsymbol{\omega}$ : 본체 각속도
$\boldsymbol{\tau}$ : 제어 입력 토크
$\boldsymbol{\tau}_d$ : 외란 토크

3.2 쿼터니언 운동학

$\dot{\mathbf{q}} = \frac{1}{2}\mathbf{q} \otimes \boldsymbol{\omega}_{\text{quat}}$

이 두 방정식이 결합되어 자세 동역학 시스템을 형성한다.

4. 비례-미분 안정화 제어

4.1 표준 PD 제어 법칙

가장 기본적인 쿼터니언 기반 안정화 제어 법칙은 PD 형태이다.

$\boldsymbol{\tau} = -\mathbf{K}_p\mathbf{q}_{e,v} - \mathbf{K}_d\boldsymbol{\omega}$

여기서 $\mathbf{q}_{e,v}$ 는 자세 오차 쿼터니언의 벡터 부분이고, $\mathbf{K}_p$ , $\mathbf{K}_d$ 는 양의 정부호 이득 행렬이다. 이 형태는 수학적 분석이 용이하면서도 실질적으로 우수한 성능을 보인다.

4.2 자세 오차의 계산

목표 자세를 $\mathbf{q}_d$ , 현재 자세를 $\mathbf{q}$ 라 할 때, 자세 오차는 다음과 같이 계산된다.

$\mathbf{q}_e = \mathbf{q}^* \otimes \mathbf{q}_d$

또는 동등하게

$\mathbf{q}_e = \mathbf{q}_d^{-1} \otimes \mathbf{q}_d$

부호 모호성을 처리하기 위해 $q_{e,w} \geq 0$ 이 되도록 부호를 조정한다.

4.3 안정성 증명

쿼터니언 기반 PD 제어 법칙의 점근 안정성은 다음의 리아푸노프 함수로 증명된다.

$V = 2k_p(1 - q_{e,w}) + \frac{1}{2}\boldsymbol{\omega}^T\mathbf{J}\boldsymbol{\omega}$

여기서 $k_p$ 는 비례 이득의 스칼라 표현이다. 이 함수는 자세 오차가 항등이고 각속도가 0일 때만 0이며 그 외에는 양이다. 폐루프 동역학을 대입하여 시간 미분을 계산하면

$\dot{V} = -\boldsymbol{\omega}^T\mathbf{K}_d\boldsymbol{\omega} \leq 0$

이고 $\dot{V} = 0$ 인 경우는 $\boldsymbol{\omega} = 0$ 이며 라살의 불변 원리에 의해 자세 오차가 항등으로 점근 수렴함이 증명된다.

5. 비선형 안정화 제어

5.1 피드백 선형화

비선형 동역학 항을 보상하는 형태의 제어 법칙은 다음과 같다.

$\boldsymbol{\tau} = \boldsymbol{\omega} \times (\mathbf{J}\boldsymbol{\omega}) - \mathbf{K}_p\mathbf{q}_{e,v} - \mathbf{K}_d\boldsymbol{\omega}$

자이로스코프 효과를 보상하는 첫 번째 항이 추가됨으로써 폐루프 동역학이 더 단순한 형태로 변환된다.

5.2 슬라이딩 모드 제어

외란과 모형 불확실성에 대한 강건성을 위해 슬라이딩 모드 제어가 사용될 수 있다. 슬라이딩 면을 다음과 같이 정의한다.

$\mathbf{s} = \boldsymbol{\omega} + \mathbf{\Lambda}\mathbf{q}_{e,v}$

여기서 $\mathbf{\Lambda}$ 는 양의 정부호 행렬이다. 제어 법칙은 슬라이딩 면을 0으로 유도하도록 설계된다.

$\boldsymbol{\tau} = \boldsymbol{\omega} \times (\mathbf{J}\boldsymbol{\omega}) - \mathbf{J}\mathbf{\Lambda}\dot{\mathbf{q}}_{e,v} - \mathbf{K}_s\mathrm{sgn}(\mathbf{s})$

이 제어 법칙은 외란에 대한 강건성을 제공하지만, 부호 함수의 불연속성으로 인한 채터링이 발생할 수 있다.

5.3 적응형 제어

관성 행렬이나 다른 매개변수가 정확히 알려지지 않은 경우 적응형 제어가 사용될 수 있다. 매개변수의 추정값을 실시간으로 갱신하여 모형 불확실성에 대응한다.

6. 외란 보상

6.1 적분 작용

PI 또는 PID 형태의 제어 법칙에서 적분 항이 정상 상태 외란을 보상한다.

$\boldsymbol{\tau} = -\mathbf{K}_p\mathbf{q}_{e,v} - \mathbf{K}_d\boldsymbol{\omega} - \mathbf{K}_i\!\int\!\mathbf{q}_{e,v}\,dt$

다만 적분 항은 와인드업 문제를 발생시킬 수 있으므로, 입력 포화가 발생하면 적분을 정지하는 와인드업 방지 메커니즘이 필요하다.

6.2 외란 관측기

외란 토크 $\boldsymbol{\tau}_d$ 를 추정하는 외란 관측기(disturbance observer)를 사용할 수도 있다. 추정된 외란을 제어 입력에서 빼서 보상한다.

$\boldsymbol{\tau} = \boldsymbol{\tau}_{\text{nominal}} - \hat{\boldsymbol{\tau}}_d$

이 방식은 다양한 외란에 대해 효과적이다.

7. 입력 포화의 처리

7.1 토크 한계

쿼드콥터의 모터는 회전 속도에 한계가 있으며, 이는 발생 가능한 최대 토크에 제약을 둔다. 제어 입력이 이 한계를 초과하면 포화가 발생한다.

$\boldsymbol{\tau}_{\text{cmd}} = \mathrm{sat}(\boldsymbol{\tau}, \boldsymbol{\tau}_{\max})$

7.2 추력 우선화

호버링 비행에서는 수직 추력이 우선되어야 하며, 자세 제어에 사용 가능한 토크가 제한된다. 모터 분배 알고리즘에서 추력과 토크의 우선순위를 적절히 조정해야 한다.

7.3 와인드업 방지

적분 항이 있는 경우 입력 포화 시 적분을 정지하거나 적분값을 감쇠시킨다. 일반적인 방법은 다음과 같다.

$\dot{\mathbf{I}} = \begin{cases} \mathbf{q}_{e,v} & \text{if not saturated} \\ \mathbf{0} & \text{if saturated} \end{cases}$

8. 큰 자세 편차에서의 안정화

8.1 회전 경로의 선택

자세 편차가 큰 경우, 자세 오차 쿼터니언의 부호 처리가 중요하다. 짧은 경로를 선택하기 위해 $q_{e,w} \geq 0$ 을 유지한다. 이는 회전 경로가 $\pi$ 라디안을 넘지 않도록 보장한다.

8.2 비선형 응답

큰 자세 오차에서는 선형화 가정이 부정확하므로, 비선형 제어 법칙이 필요하다. 쿼터니언의 벡터 부분 $\mathbf{q}_{e,v}$ 는 회전 각의 사인 절반에 비례하므로, 큰 자세에서도 유한 값을 가지며 제어 입력이 발산하지 않는다. 이는 오일러 각 기반 제어와의 중요한 차이이다.

8.3 곡예 비행 회복

곡예 비행 중 비행체가 뒤집힐 수 있다. 쿼터니언 기반 안정화 제어는 모든 자세에서 일관된 응답을 제공하므로, 어떤 자세에서도 안정화가 가능하다.

9. 자세 안정화의 매개변수 튜닝

9.1 비례 이득 $\mathbf{K}_p$

비례 이득은 자세 오차에 대한 응답의 강도를 결정한다. 일반적으로 큰 값일수록 빠른 응답을 제공하지만, 너무 크면 진동이 발생한다.

9.2 미분 이득 $\mathbf{K}_d$

미분 이득은 감쇠를 제공하여 진동을 억제한다. 비례 이득과의 비율이 시스템의 감쇠비를 결정한다.

9.3 적분 이득 $\mathbf{K}_i$

적분 이득이 있는 경우 정상 상태 오차를 제거한다. 너무 크면 과도 응답이 길어지고 와인드업 위험이 증가한다.

9.4 튜닝 절차

일반적인 튜닝 절차는 다음과 같다.

미분 이득과 적분 이득을 0으로 설정하고 비례 이득을 점진적으로 증가시킨다.
진동이 시작되는 임계 비례 이득을 찾는다.
그 이득의 약 절반에서 시작하여 미분 이득을 추가한다.
정상 상태 오차가 있으면 적분 이득을 추가한다.
다양한 비행 조건에서 응답을 확인하고 미세 조정한다.

10. 안정화 성능의 평가 지표

10.1 정착 시간

자세 편차가 일정 수준 이내로 수렴하는 데 걸리는 시간이다. 작은 정착 시간이 우수한 안정화를 의미한다.

10.2 오버슈트

목표 자세를 지나친 후 다시 수렴하는 정도이다. 작은 오버슈트가 부드러운 응답을 의미한다.

10.3 외란 응답

스텝 외란 입력에 대한 자세 응답의 크기와 회복 시간이다. 우수한 외란 거부는 안정성과 강건성을 나타낸다.

10.4 정상 상태 오차

장시간 후의 잔여 자세 오차이다. 작은 정상 상태 오차가 정확한 자세 유지를 의미한다.

11. 시뮬레이션과 실험적 검증

11.1 비선형 시뮬레이션

자세 안정화 제어기는 먼저 비선형 시뮬레이션 환경에서 검증된다. Gazebo와 SimulationLink, jMAVSim 등이 일반적으로 사용된다.

11.2 Hardware-in-the-Loop

시뮬레이션과 실제 비행 제어 컴퓨터를 결합한 HIL 검증을 통해 실시간 성능을 확인한다.

11.3 실제 비행 시험

최종 검증은 실제 비행 시험을 통해 이루어진다. 다양한 외란 조건과 비행 모드에서 안정화 성능을 평가한다.

12. 안정화 제어의 발전 방향

12.1 학습 기반 제어

강화 학습 등 학습 기반 제어가 자세 안정화에 적용되고 있다. 학습된 제어 정책이 모형 기반 제어보다 외란에 강건한 경우가 보고되고 있다.

12.2 모델 예측 제어

미래 동역학을 명시적으로 고려하는 모델 예측 제어(MPC)가 자세 제어에 사용된다. 입력 제약과 상태 제약을 명시적으로 다룰 수 있다는 장점이 있다.

12.3 견고 제어

모형 불확실성과 외란을 명시적으로 고려하는 $H_\infty$ 견고 제어가 일부 응용에서 사용된다.

13. 참고 문헌

Mellinger, D., & Kumar, V. (2011). “Minimum snap trajectory generation and control for quadrotors.” IEEE International Conference on Robotics and Automation, 2520–2525.
Lee, T., Leok, M., & McClamroch, N. H. (2010). “Geometric tracking control of a quadrotor UAV on SE(3).” IEEE Conference on Decision and Control, 5420–5425.
Fresk, E., & Nikolakopoulos, G. (2013). “Full quaternion based attitude control for a quadrotor.” European Control Conference, 3864–3869.
Wie, B., & Barba, P. M. (1985). “Quaternion feedback for spacecraft large angle maneuvers.” Journal of Guidance, Control, and Dynamics, 8(3), 360–365.
Bhat, S. P., & Bernstein, D. S. (2000). “A topological obstruction to continuous global stabilization of rotational motion and the unwinding phenomenon.” Systems & Control Letters, 39(1), 63–70.

version: 1.0