32.50 자코비안의 미분과 가속도 기구학

자코비안의 시간 미분 \dot{\mathbf{J}}은 관절 가속도와 엔드 이펙터 가속도의 관계를 구성하는 핵심 요소이며, 가속도 기구학은 속도 기구학의 자연스러운 한 차원 상위 단계이다. 가속도 수준 기구학은 매니퓰레이터 동역학, 가속도 기반 제어, 역동역학 기반 제어, 고속 궤적 계획, 고차 경로 미분 최적화의 기반이 된다. 본 절에서는 자코비안 미분의 수학적 정의, 가속도 기구학 방정식, 관절 유형별 미분 구성, 수치·해석적 계산 기법, 스크류 이론 관점의 고차 해석, 제어 응용을 해라체로 기술한다.

1. 가속도 기구학의 기본 관계

1.1 속도 관계의 시간 미분

엔드 이펙터 속도 관계 \dot{\vec{x}} = \mathbf{J}(\vec{q}) \dot{\vec{q}}를 시간에 대해 미분하면 가속도 수준 기구학 관계가 얻어진다.

\ddot{\vec{x}} = \mathbf{J}(\vec{q}) \ddot{\vec{q}} + \dot{\mathbf{J}}(\vec{q}, \dot{\vec{q}}) \dot{\vec{q}}

첫 항은 관절 가속도에 의한 즉각적 기여, 둘째 항은 자코비안의 시변성에 의한 코리올리·원심 유사 기여이다.

32.50.1.2 \dot{\mathbf{J}} \dot{\vec{q}}의 구조

둘째 항 \dot{\mathbf{J}} \dot{\vec{q}}은 관절 속도에 대해 이차 형식을 이루며, 일반적으로 다음과 같이 기술된다.

\dot{\mathbf{J}}(\vec{q}, \dot{\vec{q}}) \dot{\vec{q}} = \sum_{i,j} \frac{\partial \mathbf{J}}{\partial q_j} \dot{q}_j \dot{\vec{q}}_i = \mathbf{H}(\vec{q}) : (\dot{\vec{q}} \dot{\vec{q}}^\top)

여기서 \mathbf{H}는 자코비안의 Hessian 텐서이다. 이 이차 항이 가속도 기구학의 비선형성을 담고 있다.

1.2 역가속도 기구학

주어진 엔드 이펙터 가속도 \ddot{\vec{x}}_d에 대한 관절 가속도 해는 의사 역행렬을 이용하여

\ddot{\vec{q}} = \mathbf{J}^+(\vec{q}) \bigl( \ddot{\vec{x}}_d - \dot{\mathbf{J}}(\vec{q}, \dot{\vec{q}}) \dot{\vec{q}} \bigr) + \bigl( \mathbf{I} - \mathbf{J}^+ \mathbf{J} \bigr) \vec{\zeta}

로 주어지며, \vec{\zeta}는 임의의 영공간 가속도 벡터이다.

32.50.1.4 순기구학 사상의 2차 미분

순기구학 사상 f : \mathcal{Q} \to \mathcal{X}의 2차 미분은 가속도 관계를 생성한다. 이는 일반화 좌표에서의 연쇄 법칙을 순차적으로 적용하여 얻어지며, 텐서 표기법으로 기술된다.

32.50.2 자코비안 시간 미분의 정의

32.50.2.1 연쇄 법칙 기반 정의

자코비안의 시간 미분은 관절 변수의 함수로서의 자코비안에 연쇄 법칙을 적용하여 계산된다.

\dot{\mathbf{J}}(\vec{q}, \dot{\vec{q}}) = \sum_{i=1}^{n} \frac{\partial \mathbf{J}(\vec{q})}{\partial q_i} \dot{q}_i

각 편미분 \partial \mathbf{J} / \partial q_i는 m \times n 행렬이며, 관절 변수 q_i의 변화에 따른 자코비안의 변동률을 기술한다.

1.3 열 벡터별 미분

자코비안의 j번째 열 \vec{J}_j(\vec{q})의 시간 미분은

\dot{\vec{J}}_j(\vec{q}, \dot{\vec{q}}) = \sum_{i=1}^{n} \frac{\partial \vec{J}_j}{\partial q_i} \dot{q}_i

이며, 이를 모든 j에 대하여 모으면 자코비안 시간 미분 행렬이 구성된다.

32.50.2.3 계산 복잡도

자코비안 자체의 계산 복잡도가 \mathrm{O}(n) 또는 \mathrm{O}(n^2)인 것에 비해, 시간 미분은 자코비안의 편미분 텐서 평가를 요구하므로 일반적으로 \mathrm{O}(n^2) 또는 \mathrm{O}(n^3)의 연산을 요구한다. 단, 재귀 알고리즘을 이용하면 선형 복잡도로 계산할 수 있다.

32.50.3 관절 유형별 자코비안 열의 미분

32.50.3.1 회전 관절 열의 구조

회전 관절 i의 기하학적 자코비안 열은 다음과 같다.

\vec{J}_i = \begin{bmatrix} \hat{\vec{z}}_{i-1} \times (\vec{p}_e - \vec{p}_{i-1}) \\ \hat{\vec{z}}_{i-1} \end{bmatrix}

여기서 \hat{\vec{z}}_{i-1}은 관절 회전축 단위 벡터, \vec{p}_{i-1}은 관절 원점, \vec{p}_e는 엔드 이펙터 위치이다.

1.4 회전 관절 열의 시간 미분

회전 관절 열의 시간 미분은 다음과 같이 계산된다.

\dot{\vec{J}}_i = \begin{bmatrix} \dot{\hat{\vec{z}}}_{i-1} \times (\vec{p}_e - \vec{p}_{i-1}) + \hat{\vec{z}}_{i-1} \times (\dot{\vec{p}}_e - \dot{\vec{p}}_{i-1}) \\ \dot{\hat{\vec{z}}}_{i-1} \end{bmatrix}

\dot{\hat{\vec{z}}}_{i-1}은 관절 i-1까지의 각속도 누적에 의해 결정된다.

32.50.3.3 직동 관절 열의 구조와 미분

직동 관절 i의 자코비안 열과 그 시간 미분은 다음과 같다.

\vec{J}_i = \begin{bmatrix} \hat{\vec{z}}_{i-1} \\ \vec{0} \end{bmatrix}, \quad \dot{\vec{J}}_i = \begin{bmatrix} \dot{\hat{\vec{z}}}_{i-1} \\ \vec{0} \end{bmatrix}

직동 관절의 시간 미분은 축 방향 벡터의 시변성에만 의존한다.

1.5 축 방향 벡터의 시간 미분

\hat{\vec{z}}_{i-1}의 시간 미분은 관절 i-1까지의 링크에 누적된 각속도 \vec{\omega}_{i-1}에 의하여 주어진다.

\dot{\hat{\vec{z}}}_{i-1} = \vec{\omega}_{i-1} \times \hat{\vec{z}}_{i-1}

이 관계는 각 링크의 회전으로 인하여 기저 벡터가 시변함을 반영한다.

32.50.4 재귀 계산 기법

32.50.4.1 순방향 재귀

기저에서 엔드 이펙터로 진행하는 순방향 재귀는 각 링크의 각속도, 선속도, 각가속도, 선가속도를 순차적으로 계산한다. 자코비안과 자코비안 시간 미분의 열 벡터들은 이 과정에서 자연스럽게 얻어진다.

32.50.4.2 Newton–Euler 알고리즘

Newton–Euler 기반 순방향 동역학 알고리즘은 각 링크의 운동학적 양(속도, 가속도)을 재귀적으로 계산하면서 자코비안과 자코비안 시간 미분의 효과를 내재적으로 처리한다. Featherstone이 Rigid Body Dynamics Algorithms(Springer, 2008)에서 이 틀을 상세히 제시하였다.

32.50.4.3 공간 벡터 기법

공간 벡터(spatial vector) 기법은 각 링크의 6차원 속도·가속도를 단일 벡터로 결합하여 표기하고, 공간 자코비안과 그 시간 미분을 일관된 형식으로 재귀 계산한다. 이는 Featherstone 알고리즘의 수학적 기반이다.

32.50.4.4 복잡도 분석

공간 벡터 기반 재귀 알고리즘은 자코비안 및 자코비안 시간 미분의 계산을 \mathrm{O}(n) 복잡도로 달성한다. 이는 실시간 제어에 적합한 효율성을 제공한다.

32.50.5 동역학 방정식과의 통합

32.50.5.1 관성 행렬의 시간 미분

관절 공간 관성 행렬 \mathbf{M}(\vec{q})의 시간 미분 \dot{\mathbf{M}}(\vec{q}, \dot{\vec{q}})은 코리올리·원심 행렬 \mathbf{C}와 밀접하게 연관된다. 스큐 대칭성 조건

\dot{\mathbf{M}} - 2 \mathbf{C} = -(\dot{\mathbf{M}} - 2 \mathbf{C})^\top

은 매니퓰레이터 동역학의 에너지 보존 구조를 반영한다.

1.6 Christoffel 기호

코리올리·원심 행렬의 원소는 Christoffel 기호를 이용하여 명시적으로 기술된다.

C_{ij}(\vec{q}, \dot{\vec{q}}) = \sum_k \tfrac{1}{2} \Bigl( \frac{\partial M_{ij}}{\partial q_k} + \frac{\partial M_{ik}}{\partial q_j} - \frac{\partial M_{jk}}{\partial q_i} \Bigr) \dot{q}_k

이는 자코비안 미분과 밀접하게 연관되며, 동역학 행렬 계산에서 공통적으로 사용된다.

32.50.5.3 외부 렌치의 가속도 기구학

외부 렌치에 의한 엔드 이펙터 가속도 기여는 다음과 같이 전체 동역학에 포함된다.

\mathbf{M} \ddot{\vec{q}} + \mathbf{C} \dot{\vec{q}} + \vec{g} = \vec{\tau} + \mathbf{J}^\top \vec{\mathcal{F}}_{\mathrm{ext}}

가속도 기구학과 동역학은 자코비안의 시간 미분을 공유하여 일관된 계산 구조를 이룬다.

2. 스크류 이론 관점의 가속도

2.1 트위스트의 시간 미분

엔드 이펙터의 공간 트위스트 \vec{\mathcal{V}}의 시간 미분은 가속 트위스트(accelerating twist)이다. 공간 자코비안 \mathbf{J}_s를 이용하면 다음과 같이 기술된다.

\dot{\vec{\mathcal{V}}} = \mathbf{J}_s(\vec{q}) \ddot{\vec{q}} + \dot{\mathbf{J}}_s(\vec{q}, \dot{\vec{q}}) \dot{\vec{q}}

32.50.6.2 Lie 괄호의 등장

물체 트위스트 \vec{\mathcal{V}}_b의 시간 미분은 Lie 괄호 항을 포함한다.

\dot{\vec{\mathcal{V}}}_b = \mathbf{J}_b \ddot{\vec{q}} + \dot{\mathbf{J}}_b \dot{\vec{q}} = \mathbf{J}_b \ddot{\vec{q}} + [\vec{\mathcal{V}}_b, \mathbf{J}_b \dot{\vec{q}}] + \cdots

Lie 괄호 항은 비가환 리 대수 \mathfrak{se}(3) 구조를 반영한다.

2.2 Murray–Li–Sastry의 정식화

Murray, Li, Sastry의 A Mathematical Introduction to Robotic Manipulation(CRC Press, 1994)에서 스크류 이론 기반의 가속도 기구학이 체계적으로 제시되어 있다.

2.3 Park–Lynch의 현대 표기

Lynch와 Park의 Modern Robotics: Mechanics, Planning, and Control(Cambridge University Press, 2017)은 Product of Exponentials 정식에 기반한 자코비안과 그 미분의 현대적 표기를 제공한다.

3. 가속도 기반 제어

3.1 역동역학 제어

관절 공간 역동역학 제어 법칙은 원하는 관절 가속도 \ddot{\vec{q}}_d에 대하여 다음과 같이 기술된다.

\vec{\tau} = \mathbf{M}(\vec{q}) \ddot{\vec{q}}_d + \mathbf{C}(\vec{q}, \dot{\vec{q}}) \dot{\vec{q}} + \vec{g}(\vec{q})

원하는 관절 가속도는 작업 공간 가속도 명령으로부터 역가속도 기구학을 통해 유도된다.

32.50.7.2 작업 공간 역동역학 제어

작업 공간 역동역학 제어에서는 원하는 작업 공간 가속도 \ddot{\vec{x}}_d를 다음과 같이 관절 토크로 사상한다.

\vec{\tau} = \mathbf{M} \mathbf{J}^+ (\ddot{\vec{x}}_d - \dot{\mathbf{J}} \dot{\vec{q}}) + \mathbf{C} \dot{\vec{q}} + \vec{g}

자코비안 시간 미분 항이 명시적으로 사용된다.

3.2 PD 기반 피드백

작업 공간 PD 기반 가속도 명령은 다음과 같이 구성된다.

\ddot{\vec{x}}_d = \ddot{\vec{x}}_r + \mathbf{K}_v (\dot{\vec{x}}_r - \dot{\vec{x}}) + \mathbf{K}_p (\vec{x}_r - \vec{x})

여기서 \vec{x}_r, \dot{\vec{x}}_r, \ddot{\vec{x}}_r은 기준 궤적의 위치·속도·가속도이다.

32.50.7.4 연산 공간 동역학 제어

Khatib의 연산 공간 동역학은 가속도 수준 제어를 작업 공간에서 직접 수행한다.

\vec{\mathcal{F}} = \boldsymbol{\Lambda} \ddot{\vec{x}}_d + \boldsymbol{\mu} + \vec{p}

여기서 \boldsymbol{\mu}는 작업 공간 코리올리·원심 항이며, 자코비안 시간 미분을 포함하여 구성된다.

4. 궤적 계획과 고차 기구학

4.1 가속도 제약 궤적 계획

궤적 계획에서는 관절 가속도와 엔드 이펙터 가속도 모두에 제약이 부과된다. 최대 허용 가속도 한계 내에서 시간 최적 궤적을 생성하는 문제는 고전적 bang–bang 제어 문제이다.

4.2 Jerk 수준 제어

고주파 진동 억제를 위해 Jerk(가속도의 시간 미분) 수준까지 연속성을 부과하는 경로 계획이 사용된다. 이 경우 자코비안의 2차 시간 미분 \ddot{\mathbf{J}}까지 계산이 요구된다.

4.3 미분 평탄성

일부 매니퓰레이터 모델은 미분 평탄성(differential flatness) 성질을 갖는다. 평탄 출력의 고차 미분으로부터 모든 상태 변수와 제어 입력이 대수적으로 결정되므로, 궤적 계획이 단순화된다.

4.4 B-스플라인과 경로 매끄러움

B-스플라인 기반 관절 궤적은 경로 미분의 연속성을 자연스럽게 보장하며, 자코비안의 시간 미분 계산을 해석적으로 수행할 수 있다.

5. 수치 계산과 해석적 계산

5.1 해석적 시간 미분

자코비안의 해석적 시간 미분은 기호 미분 또는 자동 미분(automatic differentiation)을 이용하여 계산 가능하다. 자동 미분은 매니퓰레이터 모델이 프로그래밍 언어로 기술된 경우 정확도가 높은 미분 계산을 제공한다.

5.2 수치 미분

유한 차분 근사

\dot{\mathbf{J}}(\vec{q}, \dot{\vec{q}}) \approx \frac{\mathbf{J}(\vec{q} + \vec{q}_{\Delta}) - \mathbf{J}(\vec{q} - \vec{q}_{\Delta})}{2 \Delta t}

는 구현이 간단하지만, 측정 노이즈 증폭 및 시간 단계 선택 문제에 민감하다. 실시간 제어에서 주로 해석적 또는 재귀적 계산이 선호된다.

32.50.9.3 재귀 계산의 장점

재귀 Newton–Euler 알고리즘은 자코비안 시간 미분을 각 링크의 가속도 계산 과정에서 직접 얻으므로 별도의 미분 연산이 불필요하다. 이는 수치 오차와 연산 비용을 동시에 최소화한다.

32.50.9.4 자동 미분 프레임워크

Pinocchio, RBDL, Drake 등의 로봇 동역학 라이브러리는 자동 미분을 내장하여 자코비안 시간 미분을 효율적으로 계산한다. 최적화 기반 제어 및 SLAM에서 이 기능이 활용된다.

32.50.10 특이점과 가속도 기구학

32.50.10.1 가속도 수준 특이점

자코비안의 계수 저하가 가속도 수준에서도 영향을 미친다. 역가속도 기구학은 \mathbf{J}^+의 발산을 통해 관절 가속도 해의 발산을 유발한다.

32.50.10.2 감쇠 가속도 해

감쇠 최소 제곱 기반 가속도 해는 다음과 같이 구성된다.

\ddot{\vec{q}} = (\mathbf{J}^\top \mathbf{J} + \lambda^2 \mathbf{I})^{-1} \mathbf{J}^\top (\ddot{\vec{x}}_d - \dot{\mathbf{J}} \dot{\vec{q}})

이는 특이점 근방에서 가속도 해의 유계성을 보장한다.

5.3 작업 공간 가속도의 특이값 분해

작업 공간 가속도의 특이값 분해를 통해 특이 방향의 가속도 성분이 손실됨을 확인할 수 있다. 이는 속도 수준 특이 분석의 자연스러운 확장이다.

6. 본 절의 학술적 정리

본 절에서 다룬 자코비안의 미분과 가속도 기구학은 매니퓰레이터 동역학과 가속도 기반 제어의 수학적 기반을 제공한다. 자코비안 시간 미분은 속도 관계의 직접 미분으로부터 유도되며, 관절 유형별 구성, 재귀 계산, 공간 벡터 기법, 스크류 이론 기반 정식화 등 다양한 접근이 존재한다. Newton–Euler 기반 재귀 알고리즘은 자코비안 시간 미분을 \mathrm{O}(n) 복잡도로 계산하며, 실시간 동역학 제어에 적합하다. 가속도 기구학은 역동역학 제어, 연산 공간 동역학 제어, 궤적 계획, 미분 평탄성 해석의 공통 기반이며, 자코비안 시간 미분은 이들 응용의 필수 구성 요소이다. 특이점 근방에서는 감쇠 기법을 통하여 가속도 해의 유계성을 확보하며, 속도 수준과 가속도 수준 특이 분석은 서로 상보적으로 활용된다.

7. 출처

• Luh, J. Y. S., Walker, M. W., and Paul, R. P. C., “On-line computational scheme for mechanical manipulators”, Journal of Dynamic Systems, Measurement, and Control, Vol. 102, No. 2, pp. 69–76, 1980.
• Murray, R. M., Li, Z., and Sastry, S. S., A Mathematical Introduction to Robotic Manipulation, CRC Press, 1994.
• Siciliano, B., Sciavicco, L., Villani, L., and Oriolo, G., Robotics: Modelling, Planning and Control, Springer, 2009.
• Featherstone, R., Rigid Body Dynamics Algorithms, Springer, 2008.
• Lynch, K. M. and Park, F. C., Modern Robotics: Mechanics, Planning, and Control, Cambridge University Press, 2017.
• Carpentier, J. et al., “The Pinocchio C++ library: A fast and flexible implementation of rigid body dynamics algorithms and their analytical derivatives”, Proceedings of the IEEE/SICE International Symposium on System Integration, pp. 614–619, 2019.
• Craig, J. J., Introduction to Robotics: Mechanics and Control, 4th edition, Pearson, 2018.
• Spong, M. W., Hutchinson, S., and Vidyasagar, M., Robot Modeling and Control, 2nd edition, Wiley, 2020.

8. 버전

• 문서 버전: 2.0
• 작성일: 2026-04-21