10.62 쿼터니언 기반 자세 제어 법칙

1. 쿼터니언 기반 제어의 의의

쿼터니언은 자세 제어 법칙의 설계에 특히 적합한 회전 표현이다. 짐벌 락이 없고, 수치적으로 안정하며, 효율적이다. 본 절에서는 쿼터니언을 사용한 다양한 자세 제어 법칙을 체계적으로 다룬다.

2. 기본 쿼터니언 오차

쿼터니언 오차의 정의부터 시작한다.

2.1 좌측 오차

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

이는 공간 좌표계에서의 오차이다.

2.2 우측 오차

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

이는 본체 좌표계에서의 오차이다.

2.3 부호 보정

짧은 경로를 선택하기 위해 부호를 보정한다.

if q_e.w < 0:
    q_e = -q_e

3. PD 제어 법칙

가장 간단하고 일반적인 쿼터니언 기반 제어 법칙은 PD 제어이다.

3.1 표준 형태

$\boldsymbol{\tau} = -k_p\mathbf{q}_{e,v} - k_d\boldsymbol{\omega}_e$

여기서

$\mathbf{q}_{e,v}$ : 쿼터니언 오차의 벡터 부분
$\boldsymbol{\omega}_e = \boldsymbol{\omega} - \boldsymbol{\omega}_d$ : 각속도 오차
$k_p, k_d > 0$ : 제어 이득

3.2 부호의 해석

음의 부호는 오차를 줄이는 방향의 복원력을 제공한다. 오차가 양의 $\mathbf{q}_{e,v}$ 이면 $-k_p\mathbf{q}_{e,v}$ 의 토크가 오차를 줄인다.

4. Wie의 쿼터니언 피드백 제어

Wie, Weiss, Arapostathis(1989)가 제안한 고전적 쿼터니언 피드백 제어 법칙이다.

4.1 제어 법칙

$\boldsymbol{\tau} = -k_p\mathrm{sign}(q_{e,w})\mathbf{q}_{e,v} - k_d\boldsymbol{\omega}_e$

여기서 $\mathrm{sign}(q_{e,w})$ 는 스칼라 부분의 부호이다. 이는 부호 이중성을 해결한다.

4.2 특징

이 제어 법칙은 항상 짧은 경로를 선택한다. $q_{e,w}$ 가 음수이면 전체 쿼터니언 오차의 부호를 반전시키는 효과가 있다.

5. 계산 토크 제어

계산 토크(computed torque) 제어는 동적 모델을 사용한 피드 포워드와 피드백을 결합한다.

5.1 제어 법칙

$\boldsymbol{\tau} = \mathbf{J}\dot{\boldsymbol{\omega}}_d + \boldsymbol{\omega}\times\mathbf{J}\boldsymbol{\omega} + \mathbf{J}\mathbf{K}_p\mathbf{q}_{e,v} + \mathbf{K}_d\boldsymbol{\omega}_e$

5.2 각 항

$\mathbf{J}\dot{\boldsymbol{\omega}}_d$ : 목표 각가속도의 피드 포워드
$\boldsymbol{\omega}\times\mathbf{J}\boldsymbol{\omega}$ : 자이로 항 (코리올리/원심력)
$\mathbf{J}\mathbf{K}_p\mathbf{q}_{e,v}$ : 비례 피드백
$\mathbf{K}_d\boldsymbol{\omega}_e$ : 미분 피드백

5.3 특징

계산 토크 제어는 비선형 동역학을 선형화하여 표준 선형 제어 이론을 적용할 수 있게 한다.

6. 리아프노프 기반 제어

리아프노프 안정성 방법을 사용한 제어 법칙 설계이다.

6.1 리아프노프 함수

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

또는 동등하게

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

6.2 제어 법칙

리아프노프 함수의 시간 미분을 음수로 만드는 제어 법칙을 유도한다.

$\boldsymbol{\tau} = -k_p\mathbf{q}_{e,v} - k_d\boldsymbol{\omega}_e$

이는 표준 PD 제어와 같으며, 리아프노프 방법으로 안정성이 증명된다.

6.3 시간 미분

$\dot{V} = -k_d\lVert\boldsymbol{\omega}_e\rVert^2 \leq 0$

이는 시스템이 점근적으로 안정임을 보인다.

7. PID 제어

적분 항을 추가한 PID 제어가 사용될 수 있다.

7.1 제어 법칙

$\boldsymbol{\tau} = -k_p\mathbf{q}_{e,v} - k_d\boldsymbol{\omega}_e - k_i\int\mathbf{q}_{e,v}dt$

7.2 적분 항의 역할

적분 항은 정상 상태 오차를 제거한다. 일정한 외란이 있는 경우 유용하다.

7.3 주의 사항

적분 와인드업: 포화 상태에서 적분이 커질 수 있음
안정성: 적분 항이 안정성에 영향을 줄 수 있음

8. 슬라이딩 모드 제어

강건 제어의 한 형태인 슬라이딩 모드 제어이다.

8.1 슬라이딩 표면

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

8.2 제어 법칙

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

8.3 강건성

슬라이딩 모드 제어는 외란에 강건하지만, 채터링(chattering) 문제가 있을 수 있다.

9. 백스테핑 제어

백스테핑 기법은 비선형 시스템의 계층적 제어 설계이다.

9.1 단계

가상 제어 입력으로 자세를 제어한다고 가정
각속도를 가상 제어 입력의 참조로 설정
각속도 오차를 제어하는 토크 설계
리아프노프 함수로 안정성 보장

9.2 특징

백스테핑은 불확실성이 있는 시스템에서 강건 제어를 제공한다.

10. 적응 제어

시스템 매개변수(관성 텐서 등)가 불확실한 경우 적응 제어를 사용한다.

10.1 적응 제어 법칙

$\boldsymbol{\tau} = -k_p\mathbf{q}_{e,v} - k_d\boldsymbol{\omega}_e + \hat{\mathbf{J}}\dot{\boldsymbol{\omega}}_d + \boldsymbol{\omega}\times\hat{\mathbf{J}}\boldsymbol{\omega}$

여기서 $\hat{\mathbf{J}}$ 는 추정된 관성 텐서이다.

10.2 매개변수 업데이트 법칙

$\dot{\hat{\boldsymbol{\theta}}} = -\boldsymbol{\Gamma}\mathbf{Y}^T\mathbf{s}$

여기서 $\hat{\boldsymbol{\theta}}$ 는 추정된 매개변수, $\mathbf{Y}$ 는 회귀자, $\mathbf{s}$ 는 결합된 오차 신호이다.

10.3 수렴

적응 제어는 자세가 수렴함과 동시에 매개변수가 실제 값에 수렴한다(지속적 여진 조건 만족 시).

11. 강건 제어

$H_\infty$ 제어 등의 강건 제어 기법이 자세 제어에 적용된다.

11.1 접근

외란과 불확실성의 최악의 경우에 대한 성능을 최적화한다.

11.2 특징

$H_\infty$ 제어는 이론적으로 견고하지만 설계가 복잡하다.

12. 최적 제어

LQR (Linear Quadratic Regulator)과 같은 최적 제어 기법을 선형화된 자세 동역학에 적용한다.

12.1 비용 함수

$J = \int_0^\infty(\mathbf{x}^T\mathbf{Q}\mathbf{x} + \mathbf{u}^T\mathbf{R}\mathbf{u})dt$

여기서 $\mathbf{x}$ 는 상태, $\mathbf{u}$ 는 제어 입력이다.

12.2 최적 이득

Riccati 방정식을 풀어 최적 이득을 계산한다.

13. 비선형 H-infinity

비선형 $H_\infty$ 제어는 비선형 자세 동역학에 대한 강건 제어 기법이다. 이는 HJB (Hamilton-Jacobi-Bellman) 방정식의 해를 필요로 한다.

14. 제어 이득의 튜닝

14.1 해석적 방법

원하는 감쇠비 $\zeta$ 와 고유 주파수 $\omega_n$ 으로부터

$k_p = \omega_n^2, \quad k_d = 2\zeta\omega_n$

14.2 규칙 기반 튜닝

Ziegler-Nichols 등의 규칙 기반 튜닝 방법이 있다.

14.3 실험적 튜닝

시행착오로 이득을 조정한다.

14.4 최적화 기반

비용 함수를 최소화하는 이득을 최적화로 찾는다.

15. 제어 성능의 평가

15.1 시간 응답

상승 시간 (rise time)
정착 시간 (settling time)
오버슈트 (overshoot)

15.2 주파수 응답

대역폭 (bandwidth)
위상 여유 (phase margin)
이득 여유 (gain margin)

15.3 강건성

외란 거부 성능
매개변수 변화에 대한 강건성

16. 이산 시간 구현

연속 시간 제어 법칙을 이산 시간으로 구현한다.

16.1 이산화 방법

오일러 근사
Tustin 근사 (bilinear transform)
Zero-order hold

16.2 샘플링 주기

샘플링 주기의 선택은 시스템의 대역폭보다 충분히 작아야 한다 (보통 $10\times$ 이상).

17. 실용적 고려

17.1 포화 처리

tau = compute_pd_control(q_error, omega_error)
tau = clip(tau, -tau_max, tau_max)

17.2 적분 와인드업 방지

포화 시 적분을 중단하거나 감쇠시킨다.

17.3 센서 잡음 필터링

미분 피드백에 대역 제한 필터를 적용한다.

17.4 측정 지연

센서의 측정 지연을 고려하여 제어기를 설계한다.

18. 쿼터니언 기반 제어의 장점

18.1 짐벌 락 없음

쿼터니언은 짐벌 락이 없으므로 모든 자세에서 안정적으로 작동한다.

18.2 수치적 안정성

단위 노름 제약만 관리하면 수치적으로 안정적이다.

18.3 효율성

쿼터니언 연산이 회전 행렬보다 효율적이다.

18.4 일반성

많은 고급 제어 기법과 호환된다.

19. 쿼터니언 기반 제어의 한계

19.1 부호 이중성

부호 보정이 필요하다. 이를 잘 처리하지 않으면 의도하지 않은 동작이 발생할 수 있다.

19.2 직관성 부족

쿼터니언의 4 매개변수가 직관적이지 않다. 사용자 디버깅이 어려울 수 있다.

19.3 구현 복잡성

쿼터니언 연산과 변환의 구현이 필요하다. 라이브러리 지원이 유용하다.

20. 응용 사례

20.1 쿼드로터

쿼드로터의 자세 제어에 쿼터니언 PD가 표준이다. PX4, ArduPilot 등 주요 비행 제어 소프트웨어가 사용한다.

20.2 매니퓰레이터

매니퓰레이터의 말단 장치 자세 제어에 쿼터니언이 사용된다. 역기구학과 결합된다.

20.3 우주선

우주선 자세 제어에 쿼터니언 기반 PD와 리아프노프 제어가 사용된다.

20.4 수중 로봇

AUV의 자세 제어에 쿼터니언이 사용된다.

20.5 인간형 로봇

인간형 로봇의 각 관절 자세 제어에 쿼터니언이 활용된다.

21. 결론

쿼터니언 기반 자세 제어는 현대 로봇 공학과 항공 우주 분야에서 표준 기법이다. PD 제어가 가장 일반적이며, 리아프노프 방법으로 안정성이 증명된다. 계산 토크, 슬라이딩 모드, 백스테핑, 적응, 강건 제어 등 다양한 고급 기법이 쿼터니언을 기반으로 개발되어 있다. 쿼터니언의 짐벌 락 회피, 수치적 안정성, 효율성 덕분에 대부분의 현대 자세 제어 시스템이 쿼터니언을 사용한다.

22. 참고 문헌

Wie, B., Weiss, H., & Arapostathis, A. (1989). “Quaternion Feedback Regulator for Spacecraft Eigenaxis Rotations.” Journal of Guidance, Control, and Dynamics, 12(3), 375–380.
Wen, J. T., & Kreutz-Delgado, K. (1991). “The Attitude Control Problem.” IEEE Transactions on Automatic Control, 36(10), 1148–1162.
Wie, B. (2008). Space Vehicle Dynamics and Control (2nd ed.). AIAA Education Series.
Markley, F. L., & Crassidis, J. L. (2014). Fundamentals of Spacecraft Attitude Determination and Control. Springer.
Fjellstad, O. E., & Fossen, T. I. (1994). “Quaternion Feedback Regulation of Underwater Vehicles.” IEEE CCA, 857–862.

version: 1.0