6.95 자코비안 기반 궤적 추종 제어

작업 공간에서 정의된 원하는 궤적을 말단 장치가 정밀하게 추종하도록 제어하는 문제는 로봇 제어의 핵심 과제이다. 자코비안 행렬은 관절 공간과 작업 공간 사이의 미분적 관계를 제공하므로, 궤적 추종 제어기의 설계에서 중심적인 역할을 한다. 본 절에서는 자코비안에 기반한 다양한 궤적 추종 제어 방식을 다룬다.

1. 작업 공간 궤적의 정의

원하는 작업 공간 궤적은 시간의 함수로 다음과 같이 정의된다.

$\mathbf{x}_d(t) = \begin{bmatrix} \mathbf{p}_d(t) \\ \boldsymbol{\Phi}_d(t) \end{bmatrix}$

여기서 $\mathbf{p}_d(t) \in \mathbb{R}^3$ 는 원하는 위치 궤적, $\boldsymbol{\Phi}_d(t) \in \mathbb{R}^3$ 는 원하는 자세 궤적이다. 궤적에는 원하는 속도 $\dot{\mathbf{x}}_d(t)$ 와 가속도 $\ddot{\mathbf{x}}_d(t)$ 가 함께 정의된다.

2. 역속도 기구학에 기반한 속도 제어

가장 기본적인 접근법은 원하는 작업 공간 속도를 자코비안의 역(또는 의사 역)을 통해 관절 속도 명령으로 변환하는 것이다.

$\dot{\mathbf{q}}_c = J^{-1}(\mathbf{q}) \, \dot{\mathbf{x}}_d$

그러나 이 개루프(open-loop) 방식은 모델 오차와 외란에 대한 보정 능력이 없어, 오차가 시간에 따라 누적된다.

3. 폐루프 역기구학 제어

추종 오차를 궤환(feedback)으로 보정하기 위해 비례 제어항을 추가한 폐루프 방식이 사용된다. 작업 공간 오차를 다음과 같이 정의한다.

$\mathbf{e}(t) = \mathbf{x}_d(t) - \mathbf{x}(t)$

궤환을 포함한 관절 속도 명령은 다음과 같다.

$\dot{\mathbf{q}}_c = J^{-1}(\mathbf{q}) \left( \dot{\mathbf{x}}_d + K_p \, \mathbf{e} \right)$

여기서 $K_p \in \mathbb{R}^{m \times m}$ 는 양정치 비례 이득 행렬이다. 이 제어 법칙에 의한 오차 동역학은 다음과 같다.

$\dot{\mathbf{e}} + K_p \, \mathbf{e} = \mathbf{0}$

이는 지수적 감쇠를 나타내며, $K_p$ 의 고유값에 의해 수렴 속도가 결정된다. 이 방식을 CLIK(Closed-Loop Inverse Kinematics)이라 한다.

4. 작업 공간 역동역학 제어

보다 정밀한 추종을 위해 가속도 수준에서의 제어를 수행할 수 있다. 원하는 작업 공간 가속도에 오차 보정항을 포함하면 다음과 같다.

$\ddot{\mathbf{x}}_c = \ddot{\mathbf{x}}_d + K_d \dot{\mathbf{e}} + K_p \mathbf{e}$

여기서 $K_p$ , $K_d$ 는 각각 비례 및 미분 이득 행렬이다. 이를 관절 가속도로 변환하면 다음과 같다.

$\ddot{\mathbf{q}}_c = J^{-1}(\mathbf{q}) \left( \ddot{\mathbf{x}}_c - \dot{J}(\mathbf{q}) \dot{\mathbf{q}} \right)$

이 관절 가속도 명령을 로봇의 동역학 모델에 대입하여 관절 토크를 계산한다.

$\boldsymbol{\tau} = M(\mathbf{q}) \ddot{\mathbf{q}}_c + C(\mathbf{q}, \dot{\mathbf{q}}) \dot{\mathbf{q}} + \mathbf{g}(\mathbf{q})$

여기서 $M(\mathbf{q})$ 는 관성 행렬, $C(\mathbf{q}, \dot{\mathbf{q}})$ 는 코리올리-구심력 행렬, $\mathbf{g}(\mathbf{q})$ 는 중력 벡터이다. 결과적인 폐루프 오차 동역학은 다음과 같다.

$\ddot{\mathbf{e}} + K_d \dot{\mathbf{e}} + K_p \mathbf{e} = \mathbf{0}$

$K_p$ 와 $K_d$ 를 적절히 선택하면 임계 감쇠(critical damping) 또는 원하는 고유 진동수와 감쇠비를 달성할 수 있다.

5. 작업 공간에서의 직접 제어

자코비안을 이용하여 동역학 방정식 자체를 작업 공간으로 변환하면, 작업 공간에서 직접 제어 법칙을 설계할 수 있다. 작업 공간 동역학은 다음과 같다.

$M_x(\mathbf{q}) \ddot{\mathbf{x}} + C_x(\mathbf{q}, \dot{\mathbf{q}}) \dot{\mathbf{x}} + \mathbf{g}_x(\mathbf{q}) = \mathbf{F}$

여기서

$M_x = J^{-\top} M J^{-1}, \quad \mathbf{g}_x = J^{-\top} \mathbf{g}$

작업 공간 제어 입력은 다음과 같이 설계된다.

$\mathbf{F} = M_x \left( \ddot{\mathbf{x}}_d + K_d \dot{\mathbf{e}} + K_p \mathbf{e} \right) + C_x \dot{\mathbf{x}} + \mathbf{g}_x$

이를 관절 토크로 변환하면 $\boldsymbol{\tau} = J^\top \mathbf{F}$ 이다.

6. 자세 오차의 정의

위치 오차 $\mathbf{e}_p = \mathbf{p}_d - \mathbf{p}$ 는 단순한 벡터 감산으로 정의되지만, 자세 오차는 회전 행렬의 비선형적 구조로 인해 주의 깊은 정의가 필요하다. 대표적인 자세 오차 정의는 다음과 같다.

$\mathbf{e}_o = \frac{1}{2}\left(\mathbf{n} \times \mathbf{n}_d + \mathbf{s} \times \mathbf{s}_d + \mathbf{a} \times \mathbf{a}_d\right)$

또는 축-각 표현에 기반하여 오차 회전 행렬 $R_e = R_d R^\top$ 의 로그를 사용한다.

$\mathbf{e}_o = \theta_e \hat{\mathbf{k}}_e$

여기서 $(\hat{\mathbf{k}}_e, \theta_e)$ 는 오차 회전 행렬의 축-각 표현이다.

7. 여유 자유도 시스템에서의 궤적 추종

여유 자유도 로봇에서의 폐루프 역기구학 제어는 영 공간 투영을 포함하여 다음과 같이 확장된다.

$\dot{\mathbf{q}}_c = J^\dagger \left( \dot{\mathbf{x}}_d + K_p \mathbf{e} \right) + (I - J^\dagger J) \mathbf{z}$

여기서 $\mathbf{z}$ 는 부차 목표를 추구하는 영 공간 운동 성분이다. 이를 통해 궤적을 추종하면서 동시에 특이점 회피, 관절 한계 회피 등의 부차 목표를 달성할 수 있다.

8. 특이점 근방에서의 궤적 추종

특이점 근방에서 표준 역자코비안 방법은 수치적 불안정을 유발하므로, 댐핑 최소 제곱법을 적용한다.

$\dot{\mathbf{q}}_c = J^\top(JJ^\top + \lambda^2 I)^{-1} \left( \dot{\mathbf{x}}_d + K_p \mathbf{e} \right)$

댐핑 계수 $\lambda$ 의 도입은 추종 정밀도와 수치적 안정성 사이의 절충(trade-off)을 야기한다. 특이점 근방에서는 말단 장치의 작업 공간 궤적에서 벗어남을 감수하고 관절 속도의 발산을 방지하는 것이 실용적으로 바람직하다.

9. 참고 문헌

Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2009). Robotics: Modelling, Planning and Control. Springer.
Craig, J. J. (2005). Introduction to Robotics: Mechanics and Control. 3rd ed. Pearson Prentice Hall.
Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2006). Robot Modeling and Control. John Wiley & Sons.
Khatib, O. (1987). “A Unified Approach for Motion and Force Control of Robot Manipulators: The Operational Space Formulation.” IEEE Journal on Robotics and Automation, 3(1), 43–53.
Sciavicco, L., & Siciliano, B. (2000). Modelling and Control of Robot Manipulators. 2nd ed. Springer.

v 0.1